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ABSTRACT 

Planning  efficient  long-range  movement  is  a  fundamental  requirement  of  most  military  operations. 
Intelligent  mobile  autonomous  vehicles  designed  for  battlefield  support  missions  must  have  this  capability. 
We  propose  an  efficient  heuristic  algorithm  for  planning  near-optimal  high-level  routes  through  complex 
terrain  maps,  modeled  by  the  Weighted-Region  Problem  (WRP).  The  algorithm  is  driven  by  our  adaptation 
of  the  combinatorial  optimization  technique  called  simulated  annealing.  The  WRP  provides  a 
cartographically  powerful  representation  for  planar  maps.  Terrain  features  are  modeled  by  polygonal 
homogeneous-cost  regions.  A  cost  coefficient  assigned  to  each  region  indicates  the  relative  cost  per  unit 
distance  for  movement  in  that  region  by  a  point  agent  on  the  ground.  Region  cost  coefficients  are  assumed  to 
be  invariant  with  direction  of  movement.  Given  a  start  and  a  goal  point,  a  solution  (not  necessarily  optimal) 
is  a  set  of  piecewise-linear  connected  segments,  spanning  from  start  to  goal.  The  cost  of  a  solution  path  is  the 
sum  of  the  weighted  lengths  of  all  segments  in  the  path,  where  the  weighted  length  of  each  segment  is  the 
product  of  its  Euclidean  length  and  the  cost  coefficient  of  the  region  it  crosses.  Ideally,  we  seek  the  least  cost 
path.  However,  as  problem  instances  approach  the  actual  complexity  of  the  battlefield,  faster  solutions 
become  more  desirable  than  absolute  optimality.  We  introduce  heuristics  designed  to  reduce  the  search  space 
independently  of  start  and  goal  location,  thus,  allowing  map  preprocessing.  We  use  other  heuristics  to 
improve  the  efficiency  of  local  cost  function  optimization  as  well  as  the  annealing  process  itself. 
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I.  INTRODUCTION 

A.  OVERVIEW 

Planning  efficient  long-range  movement  using  map  data  is  fundamental  to  most  military  operations. 
Intelligent  mobile  autonomous  vehicles  designed  for  battlefield  support  missions  must  also  do  this.  Within 
the  last  decade,  successes  in  the  development  and  practical  use  of  robotic  and  automation  equipment  have 
created  a  demand  for  more  efficiency  and  capability  in  autonomous  machines  [Iyen89].  Furthermore,  U.S. 
Department  of  Defense  interest  in  autonomous  land  vehicles  [Keir88,  Keir84],  automated  battle  management 
systems  [Wilb89],  and  digital  terrain  analysis  [Digi88,  Clev84],  has  significandy  augmented  this  demand. 
Inspired  by  these  requirements,  this  dissertation  presents  our  design  and  implementation  of  an  efficient 
algorithm  for  high-level  route  planning  through  complex  terrain.  Our  algorithm,  which  we  refer  to  as  path 
annealing,  finds  solutions  to  what  has  been  called  the  weighted-region  problem  [Mitc90]. 

Most  previous  approaches  to  the  weighted  region  problem  have  used  systematic  search  methods.  Such 
techniques  may  extract  huge  overheads  for  agenda  maintenance.  When  problem  instances  become  large  and 
complex,  even  heuristics  can  be  ineffective  in  reducing  the  combinatorics.  In  contrast,  path  annealing 
employs  a  form  of  adaptive  local  search,  which  samples  the  solution  space  and  eliminates  the  need  to  maintain 
expensive  agendas.  As  the  name  suggests,  path  annealing  is  based  on  the  probabilistic  search  technique 
known  as  simulated  annealing,  which  was  first  explored  independently  by  [Kirk83]  and  [Cern85].  In  adapting 
this  technique  to  solve  the  weighted  region  problem,  we  have  also  designed  many  heuristics  based  on 
annealing,  spatial  reasoning,  and  geometry.  These  enhance  performance  and  also  tend  to  compensate  for  the 
weaknesses  inherent  in  local  search.  Empirical  studies  indicate  that  compared  to  A*  search  on  relatively  large 
problem  instances,  path  annealing  has  significantly  lower  execution  times,  while  sacrificing  very  little 
solution  accuracy.  Although,  our  algorithm  cannot  guarantee  a  globally  shortest  path,  our  empirical  study 
indicates  that  it  will  find  it  quite  often. 

B.  DEFINITION  OF  THE  WEIGHTED-REGION  PROBLEM  (WRP) 

The  weighted  region  problem  (WRP)  uses  a  mathematically  simple,  yet  cartographically  powerful 
problem  representation.  Input  to  the  WRP  is  a  two-dimensional  planar  map,  which  models  terrain  features  as 
convex  polygonal  homogeneous-cost  regions.  We  say  that  a  WRP  map  is  a  connected  planar  straight-line 


graph  which  partitions  two-dimensional  space  into  cost  regions.  Each  cost  region  is  assigned  a  cost 
coefficient,  which  is  a  weighting  value  indicating  the  relative  cost  per  unit  distance  for  movement  through 
that  region  by  a  point  agent.  Cost  regions  are  assumed  to  be  isotropic,  so  that  their  respective  cost  coefficients 
are  invariant  with  respect  to  direction  of  movement.  Without  loss  of  generality,  cost  coefficients  are  integers 

taken  from  the  set  [w,  w+1,  w+2 W,+<*>}t  where  w  and  W  are  the  minimum  and  maximum  weights 

respectively.  If  necessary,  rational  number  coefficients  can  always  be  handled  by  rescaling  [Mitc90].  A 
weighted-region  problem  instance  is  a  WRP  map  specified  in  terms  of  boundary  edges  and  cost  coefficients, 
and  designated  start  and  goal  points  corresponding  to  the  current  location  and  projected  destination  of  the 
agent. 

A  solution  (not  necessarily  optimal)  is  a  set  of  piecewise  linear  connected  line  segments,  which  spans 
from  start  point  5  to  goal  point  G  (see  Figure  1.1).  Denote  this  path  as  P  .  The  interior  points  of  each  segment 
of  P  lie  either  entirely  within  a  single  cost  region,  or  entirely  on  a  single  cost  region  boundary.  Segment 
end  points  lie  on  region  boundary  edges  or  vertices.  The  total  cost  oiP  is  the  sum  of  the  weighted  lengths 
of  all  segments  of  the  path,  where  the  weighted  length  of  segment  i  is  the  product  of  its  Euclidean  length,  d., 
and  the  cost  coefficient,  \x  ,  of  the  region  through  which  it  passes: 

KSGI-SOW  (Eql.D 

i 

A  path  segment  which  coincides  with  all  or  part  of  a  boundary  edge  incurs  the  lesser  cost  of  the  two  regions 
separated.  An  optimal  solution,  P  ,  is  the  minimization  of  Eq  1.1,  a  globally  least  cost  path  from  S  to  G. 
Measured  in  time  units,  it  represents  the  fastest  route  from  start  to  goal. 

We  make  several  additional  assumptions  regarding  the  input  map.  We  assume  that  all  weighted  regions 
are  convex.  Even  if  this  is  not  the  case,  it  is  always  possible  to  insert  additional  boundary  edges  between 
existing  vertices  to  make  all  regions  convex.  Such  edges  will  become  boundaries  between  regions  of  equal 
cost.  We  will  refer  to  these  as  phantom  edges  because  their  sole  purpose  is  to  ensure  convexity.  Border  edges 
and  border  vertices  define  the  outer  limits  of  the  map,  and  bound  the  only  non-convex  region.  The  current 
implementation  of  path  annealing  requires  that  linear  regions  (as  used  in  [Rowe90a]  and  [Mitc90])  must  be 
modeled  by  regions  of  positive  (non-zero)  area.  However,  this  restriction  is  not  essential  to  the  algorithm 
itself,  and  can  be  removed  by  a  few  data  structure  modifications. 


Figure  1.1    Weighted-Region  Problem  Instance  and  One  Possible  Solution 

(not  necessarily  optimal) 


C.      WHY  A  STOCHASTIC  APPROACH? 

Algorithms  based  on  systematic  search  methods  apply  some  deterministic  ordering  to  nodes  in  a  state 
space  search.  The  usual  reason  for  this  is  to  guarantee  search  completeness,  which  may  be  the  only  known 
way  to  guarantee  the  optimality  of  a  solution.  Such  algorithms  must  track  a  large  number  of  partial  solutions 
using  an  agenda.  However,  this  does  not  imply  that  ordered  search  is  necessarily  exhaustive.  Heuristics  and 
bounds  may  provide  sufficient  cause  to  prune  partial  solutions  from  further  consideration.  Nevertheless,  such 
search  organization  sometimes  carries  a  hefty  price  in  the  form  of  agenda  maintenance.  Larger,  more 
complicated  problem  instances  will  generally  require  more  effort  of  these  deterministic  algorithms,  likely 
forcing  unacceptably  worst  case  performance. 


Rather  than  incur  the  overhead  for  organized  search,  we  propose  to  reduce  the  effort  by  using  stochastic 
search.  Path  annealing  is  our  customization  of  simulated  annealing  [Kirk83],  a  probabilistic  combinatorial 
optimization  technique  which  finds  near-optimal  solutions  to  problems  having  very  large  and  complex  search 
spaces.  The  annealing  approach  to  the  WRP  may  seem  strange  for  several  reasons.  First,  the  WRP  is 
polynomially  solvable  [Mitc90],  yet,  annealing's  primary  domain  of  application  is  generally  considered  to  be 
the  class  of  NP-Hard  problems.  Second,  simulated  annealing  has  often  been  criticized  for  its  large  running 
times  which  are  sometimes  necessary  to  ensure  good  solutions.  Finally,  for  some  problems,  annealing  has 
made  a  relatively  poor  showing  against  good  problem-specific  heuristics  [Naha85].  Although  annealing  may 
not  appear  to  be  the  correct  tool  for  the  WRP,  our  empirical  studies  tend  to  indicate  otherwise. 

Annealing  experiments  with  the  Traveling  Salesman  Problem  exhibit  a  property  which  is  similar  to  a 
human  approach  to  route  planning.  Consider  planning  a  long-range  automobile  trip  using  a  road  atlas.  Most 
people  form  a  solution  hierarchically,  descending  top-down  through  levels  of  abstraction  from  interstate 
expressways  to  state  highways  to  local  roads.  Two  basic  forms  of  knowledge  contribute  to  this  natural 
tendency.  The  first  is  general  knowledge  of  speeds  and  traffic  patterns  associated  with  the  major  classes  of 
roads.  The  second  is  specific  experience-based  and  analogical  knowledge  about  road  quality  and  traffic 
patterns  in  local  areas  of  the  map.  To  solve  the  Traveling  Salesman  Problem,  simulated  annealing  forms  a 
solution  in  mis  same  top-down  progression  [Kirk83].  Starting  with  an  initial  feasible  solution,  the  algorithm 
samples  the  search  space  by  rapidly  generating  and  testing  random  solutions.  In  uie  beginning  the  process 
finds  many  of  the  best  gross  high-level  solutions.  The  effects  of  random  samples  are  gradually  constrained  so 
that  these  gross  high-level  solutions  tend  to  freeze  into  the  evolving  detailed  solution.  Later  stages  of  the 
process  generate  and  test  smaller  local  changes,  gradually  refining  the  lower-level  details  of  a  final  near- 
optimal  solution. 

Hard  optimization  problems  with  complex  solution  spaces  usually  have  a  large  number  of  local  minima 
with  costs  very  near  to  that  of  the  optimal  solution(s)  [Kirk83].  The  WRP  solution  space,  characterized  by 
multiple  local  minima,  appears  to  be  well-suited  for  a  stochastic  approach,  especially  in  larger  problem 
instances.  A  high  resolution  requirement  for  terrain  modeling  could  easily  produce  a  problem  instance  which 
would  be  arbitrarily  complex  in  terms  of  vertices,  boundary  edges,  regions,  and  their  shapes  and  orientations. 
Consider  the  case  of  an  input  map  which  is  an  approximate  model  of  the  real  world.  The  sensitivity  of  true 
optimal  paths  to  very  small  changes  in  geometry  and  cost  coefficient  magnitude  suggests  that  the  effort 
associated  with  finding  a  true  optimal  path  is  rarely  worth  the  result.  Simulated  annealing  proceeds  under  this 
assumption,  and  finds  a  near-best  solution  without  the  expense  of  systematically  proving  its  worth. 


New  approaches  to  problems  often  suggest  additional  constraints,  heuristics,  or  bounds  which  might  not 
have  been  possible  with  earlier  methods.  Experience  with  annealing  indicates  that  tailored  heuristics  can 
increase  its  efficiency  [Rome84b,  Whit84,  Gree84,  Naha85,  Adam85].  We  have  borrowed  several  methods 
of  improvement  from  previous  work.  In  addition,  we  have  developed  several  of  our  own  heuristics  and 
constraint  mechanisms  which  are  specific  to  the  WRP  and  path  annealing.  Some  of  our  heuristics  can  also 
support  other  path  planning  algorithms.  Our  stochastic  approach  to  the  WRP  attempts  to  merge  simple 
intelligence  with  practical  engineering  by  coupling  simple  heuristics  to  non-exhaustive,  controlled  sampling. 

D.      APPLICATIONS 

If  we  consider  the  WRP  in  a  military  planning  context,  then  its  significance  to  automated  route  planning 
becomes  more  apparent.  The  problem  is  generic  enough  to  model  a  variety  of  spatially  oriented  applications. 
For  a  given  map,  regions  and  associated  cost  coefficients  can  represent  any  unit  of  measure  provided  that 
within  each  region,  cost  remains  isotropic,  homogeneous,  and  varies  linearly  with  planar  distance.  Examples 
of  cost  measure  include  ease  of  movement  through  terrain,  cover  and  concealment,  exposure  to  enemy 
positions,  fuel  or  energy  consumption,  lethality  of  enemy  weapons,  or  areas  of  contamination  [Wilb89, 
Rowe90d].  Multiple  weighted-region  maps  could  be  merged  by  overlaying  one  atop  another  and  performing 
a  combining  operation  on  the  cost  coefficients  of  intersecting  areas.  The  composite  map  would  have 
additional  new  vertices  and  regions  with  revised  boundary  edges  resulting  from  boundary-edge  intersections 
and  region  overlaps.  A  route  planning  algorithm  operating  on  such  a  map  would  simultaneously  optimize 
over  several  mission-critical  parameters.  For  example,  by  using  cost  coefficients  obtained  from  weighting  the 
the  relative  importance  of  each  cost  parameter,  an  optimal  solution  on  such  a  composite  map  might  represent 
the  path  of  combined  minimum  travel  time,  least  exposure  to  the  enemy,  and  maximum  survivability 
[Dent84].  In  general,  the  complexity  of  route-planning  on  merged  maps  grows  with  the  number  of  boundary 
edge  intersections  and  cost  region  overlaps.  The  need  for  fast  solutions  assumes  increasing  importance  as  the 
scope  of  a  problem  instance  approaches  the  reality  and  complexity  of  battlefield  mission  planning. 

For  a  given  problem  instance,  each  execution  of  a  stochastic  algorithm  can  result  in  a  different  solution. 
Whether  executed  in  a  parallel  processing  environment  or  given  ample  time  to  conduct  multiple  executions 
serially,  the  best  outcomes  can  be  selected.  A  collection  of  different  solutions  from  several  processors  can 
provide  insights  into  terrain  overlays  that  might  otherwise  go  unnoticed.  For  example,  high-speed  avenues  of 
approach,  key  choke  points,  and  major  by  passing  routes  become  more  apparent  as  the  military  planner 
correlates  multiple  solutions. 


Solutions  generated  by  a  nondeterministic  approach  such  as  path  annealing  are  appealing  from  the 
military  commander's  perspective  for  several  reasons.  A  globally  optimal  path  returned  by  a  deterministic 
algorithm  is  predictable  and  may  be  very  undesirable  in  an  offensive  tactical  plan.  An  algorithm  which  only 
finds  a  globally  optimal  path  for  a  given  problem  instance  will  convey  little  surprise  to  an  enemy,  since  he 
can  do  likewise  with  a  deterministic  algorithm!  On  the  other  hand,  a  stochastic  algorithm  has  a  reasonably 
good  probability  of  discovering  an  optimal  solution,  but  one  of  many  near-optimal  paths  may  be  more  likely. 
Since  such  paths  are  not  always  spatially  close  to  the  optimal,  routes  found  by  the  stochastic  algorithm  are 
not  always  predictable. 

If  route  planning  must  be  conducted  under  time-variable  constraints,  then  nondeterministic  path 
annealing  has  a  definite  advantage  over  the  systematic  approaches.  Systematic  search  usually  must  run  to 
completion  or  near-completion  in  order  to  obtain  a  complete  solution.  In  contrast,  an  annealing  algorithm 
approaches  the  optimal  solution,  i.e.  its  theoretical  asymptotic  limit,  as  time  of  execution  approaches  infinity 
[Rome84a].  This  means  that  the  quality  of  a  solution  can  improve  with  time.  The  starting  point  of  annealing 
is  a  feasible  solution.  Therefore,  even  when  time  constraints  are  uncertain,  it  would  be  possible  to  abort  path 
annealing  prematurely  to  return  the  best  solution  currently  known.  The  more  time  alloued  to  the  algorithm, 
the  more  opportunities  exist  for  solution  improvement. 

As  we  have  said,  an  important  advantage  provided  by  path  annealing  is  its  ability  to  achieve  dramatic 
reductions  in  average  computation  time  necessary  to  find  good  solutions,  particularly  as  problem  instances 
become  larger  and  more  complex.  This  is  because  the  annealing  algorithm  only  samples  the  solution  space, 
and  is  guided  probabilistically  by  the  sampling  results.  The  random  nature  of  the  sampling  process  means  that 
overhead  for  maintenance  of  partial  solutions  in  an  ordered  agenda  is  unnecessary.  In  general,  a  predefined 
set  of  parameters  constituting  an  annealing  schedule  determines  the  expected  running  time  of  an  annealing 
algorithm.  Figures  5.33  and  5.34  in  Chapter  V  (page  125)  show  time  of  execution  as  a  function  of  problem 
size  for  66  different  weighted-region  problem  instances  for  A*  search  and  path  annealing  respectively.  This 
figure  illustrates  our  claim  that  path  annealing  can  require  significantly  less  average  running  time  than  a 
typical  systematic  search  algorithm.  In  a  majority  of  these  66  cases  the  total  weighted  path  cost  of  the  path 
annealing  solution  is  the  same  (or  nearly  the  same)  as  the  systematic  search  solution  cost. 

E.      ORGANIZATION  OF  CHAPTERS 

We  begin  in  Chapter  II  by  discussing  basic  concepts  and  terms  relevant  to  this  and  previous  research. 
The  chapter  summarizes  past  approaches  to  solving  the  WRP  and  closely  related  problems,  emphasizing 


strengths  and  weaknesses.  We  also  discuss  simulated  annealing  and  some  examples  of  its  uses.  In  Chapter  III 
we  present  the  development  of  path  annealing.  This  chapter  is  organized  around  the  components  of  a  basic 
annealing  algorithm.  While  only  a  few  enhancements  are  discussed  in  Chapter  III,  Chapter  IV  emphasizes 
performance  improvements  to  path  annealing  that  are  achieved  through  heuristics  and  bounds.  Some  of  these 
are  applicable  to  other  approaches  to  the  problem  as  well.  In  order  to  test  and  evaluate  path  annealing,  we 
must  have  a  valid  means  of  comparison  and  control.  Chapter  V  begins  with  a  discussion  of  the  wavefront 
propagation  algorithm.  We  then  describe  another  simple  control  algorithm  which  is  uniquely  different  from 
previous  algorithms  for  the  WRP.  We  refer  to  it  as  uniform-discrete-point  global  A*  (UDPGA*)  search.  We 
compare  the  performance  of  UDPGA*  to  wavefront  propagation  and  show  that  UDPGA*  is  a  faster,  more 
accurate  systematic  search  algorithm.  We  then  directly  compare  path  annealing  with  UDPGA*  for  a  variety 
of  maps.  The  remainder  of  Chapter  V  is  a  summary  of  these  test  results  and  analysis.  Chapter  VI  summarizes 
our  conclusions  and  suggests  extensions  to  this  research. 


H.  RELEVANT  CONCEPTS  AND  PREVIOUS  RESEARCH 

A.      FUNDAMENTAL  CONCEPTS 
1.      Problem  Representation 

a.     High-Level  vs.  Low-Level  Path  Planning 

The  work  reported  in  this  dissertation  addresses  only  high-level  aspects  of  path  planning.  In 
high-level  route  planning  we  assume  that  the  moving  agent  is  a  point  which  has  no  physical  dimension.  Thus, 
there  is  no  consideration  of  restrictions  to  movement  due  to  the  agent's  width  or  height.  This  is  a  reasonable 
assumption  when  the  map  scale  is  of  relatively  low  resolution  as  compared  to  the  size  of  a  human  or  a  small 
vehicle.  We  have  tested  our  algorithms  on  a  1000  meter  grid  square  extracted  from  a  standard  1:50000  scale 
military  map  [Defe74].  One  unit  of  distance  in  our  test  maps  is  equivalent  to  approximately  10  meters  distance 
on  the  ground.  For  a  small  vehicular  agent,  this  is  probably  close  to  the  maximum  resolution  before  height 
and  width  constraints  become  active. 

A  high-level  solution  provides  a  general  route  for  cross-country  movement.  The  agent  may 
still  require  a  low-level  path  planning  system  to  navigate  the  path.  The  low-level  planner  accumulates  local 
sensory  input  and  applies  spatial  reasoning  to  refine  and  safely  follow  the  route  as  necessary  for  actual 
movement.  Our  work  does  not  concern  planning  at  this  level. 

The  goodness  of  a  high-level  solution  depends  to  a  large  degree  on  how  well  the  map 
represents  the  realities  of  the  terrain.  The  fact  that  WRP  maps  approximate  curved  features  with  straight  lines 
is  one  source  of  representation  error.  Another  source  can  result  from  cost  coefficient  assignment  which  is 
inconsistent  with  the  actual  cost  per  unit  distance  for  movement  on  the  ground.  The  mechanical  aspects  of  our 
algorithm  design  assume  that  input  maps  are  perfect  representations  of  the  terrain.  However,  of  necessity,  the 
representation  of  curves  by  straight  lines  normally  approaches  some  finite  precision  (though  possibly  very 
small).  Therefore,  maps  will  usually  differ  from  reality  to  some  degree.  Our  design  takes  a  pragmatic 
approach  to  optimization.  There  is  Utile  reason  to  expend  large  amounts  of  time  searching  exhaustively  for  a 
solution  whose  optimality  may  be  questionable.  In  larger,  more  complex  problem  instances,  there  may  be 
many  near-optimal  routes  from  which  to  select. 


b.  Graph  Search  vs.  Spatial  Reasoning  Approaches 

There  are  two  general  approaches  to  route  finding:  graph  search  and  spatial  reasoning.  The 
graph-search  approach  represents  the  search  space  as  a  network  of  nodes  and  arcs  through  which  a  route  must 
be  found.  The  major  advantage  here  is  the  ability  to  apply  graph  theory  to  obtain  solutions.  The  very  nature 
of  many  well-defined  search  problems  dictates  this  discrete  approach.  Path  constraints  are  the  usual  reason. 
For  example,  in  city  route  planning  for  an  automobile,  clearly,  there  is  no  reason  to  consider  off-road 
movement.  In  contrast,  a  spatial-reasoning  approach  considers  the  significance  of  shape,  size,  and  orientation 
of  features  of  the  environment.  The  geometry  of  space  and  its  effect  on  the  cost  of  movement  becomes  more 
important. 

It  appears  that  a  graph-search  approach  alone  cannot  sufficiently  capture  the  spatial 
relationships  inherent  in  a  weighted-region  problem  (WRP)  instance.  Most  of  the  previous  work  in  the  WRP 
makes  heavy  use  of  spatial  reasoning  to  develop  constraints  and  bounds  on  the  locations  and  costs  of  optimal 
solution  paths.  Searching  outward  systematically  from  the  start  point,  these  constraints  are  continually 
tightened  until  only  a  few  routes  remain  that  can  satisfy  conditions  for  global  optimality.  Then,  either  a  graph 
search  or  cost  comparison  selects  the  optimum. 

Path  annealing  combines  graph  search  and  spatial  reasoning  in  a  more  balanced  mix. 
Whereas  most  of  the  previous  algorithms  focused  on  spatial  reasoning  to  build  a  global  solution,  path 
annealing  uses  a  fast,  low-resolution  graph  search  to  get  an  initial  solution.  From  this  solution  the  algorithm 
probabilistically  explores  local  spatial  relationships  among  neighboring  paths.  Local  graph  search  and  the 
application  of  spatial  constraints  determine  local  optimal  path-costs  necessary  to  develop  these  relationships. 
The  cumulative  effect  of  all  of  this  localized  activity  gradually  determines  a  refined  global  solution. 

c.  Discrete  vs.  Continuous  Representation 

Optimization  problems  may  be  classified  into  two  general  categories  -  continuous  and 
discrete  [Papa82].  The  discrete  problems  are  also  called  combinatorial  optimization  problems.  The  solution 
techniques  for  each  category  are  usually  quite  different  and  depend  upon  the  form  of  the  input.  For  example, 
calculus  and  binary  search  are  two  typical  methods  of  continuous-variable  optimization.  Which  to  apply 
depends  upon  whether  a  continuous  function  is  input  as  an  equation  or  as  raw  data.  On  the  other  hand, 
standard  graph  theory  provides  discrete  optimization  techniques  for  finding  shortest  paths  in  networks  of 
weighted  arcs. 


The  WRP  has  both  discrete  and  continuous  characteristics.  Two-dimensional  Euclidean 
space  imposes  an  uncountably  infinite  set  of  feasible  paths  between  any  pair  of  points,  implying  that 
continuous  optimization  might  be  applicable.  However,  the  need  to  manage  combinatorial  complexity 
encourages  a  discrete  flavor  in  problem  representation.  A  finite  set  of  boundary  edges  and  vertices  partitions 
the  continuous  space  of  weighted  region  maps.  The  geometric  simplicity  of  the  resulting  polygons  provides 
a  natural  way  to  manage  the  complexity  and  continuity  of  the  WRP.  We  can  divide  a  problem  instance  into  a 
finite  set  of  continuous  path  subspaces  whose  boundaries  are  defined  by  the  discrete  edges  and  vertices. 
Figure  2.1  depicts  one  such  path  subspace  as  defined  by  [Rich87]. 

The  convexity  theorem  of  [Rowe90b,  Mitc90]  lends  further  support  for  such  a  discrete 
representation.  Simply  stated,  it  concludes  that  for  any  path  subspace  with  common  start  point  and  which 
crosses  the  same  ordered  sequence  of  boundary  edges,  weighted  cost  is  a  convex  function  of  the  parameters 
necessary  to  specify  a  path.  The  path  subspace  in  Figure  2.1  satisfies  the  conditions  of  this  theorem.  The 
parameters  necessary  to  specify  each  path  are  the  coordinates  of  the  start  point  and  the  boundary  crossings. 
The  theorem  implies  that  there  must  exist  within  this  subspace  a  unique  path  with  minimum  weighted  cost. 
A  continuous-function  optimization  technique  (e.g.  binary  search)  can  determine  this  minimum  cost  path. 


Figure  2.1      Well-Behaved  Path  Subspace  (also  called  a  wedge) 
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We  can  take  advantage  of  the  convexity  theorem  by  allowing  boundary  edges  and  vertices  to 
define  a  discrete  set  of  path-subspaces  between  start  and  goal.  Each  subspace  contains  a  continuous  family  of 
paths.  By  the  convexity  theorem  we  can  obtain  the  locally  shortest  path  within  each  subspace.  However,  there 
are  other  advantages.  Discrete  data  structures  are  easy  to  implement  and  can  efficiently  support  both  graph 
search  and  spatial  reasoning.  Another  advantage  is  that  imposing  a  discrete  structure  on  continuous  space 
results  in  a  combinatorial  optimization  problem.  While  the  search  space  may  be  very  large,  it  is  nevertheless 
finite. 

2.      Sources  of  Error 

a.      Terrain  Representation 

Recall  that  in  Section  A.l.a  of  this  chapter  we  briefly  addressed  terrain  representation  error. 
The  solution  accuracy  for  all  current  WRP  solution  techniques  is  dependent  upon  the  accuracy  with  which 
straight  lines  approximate  curves.  This  may  have  a  direct  influence  on  the  size  of  a  problem  instance.  The 
more  straight  lines  necessary  to  maintain  terrain  representation  accuracy  requirements,  the  larger  will  be  the 
number  of  vertices  and  edges  in  the  map.  The  other  source  of  representation  error  results  from  the  use  of 
homogeneous-cost  regions.  Of  necessity,  these  regions  are  bounded  areas.  Their  cost  coefficient  values  are 
subjective  averages,  assigned  because  they  best  approximate  cost  per  unit  movement  within  that  area  from  a 
high-level  perspective.  While  errors  will  always  exist,  we  assume  that  they  will  tend  to  cancel  one  another  or 
average  out  over  an  entire  high-level  solution  path. 

We  can  quantify  the  effect  of  cost  coefficient  assignment  error  as  follows.  Let  H  represent 
the  maximum  difference  between  assigned  and  true  cost  coefficient  values  over  all  regions  of  the  map.  If  p. 
represents  the  maximum  cost  coefficient,  then  for  a  path  of  unweighted  length  L,  HL\i  is  the  absolute 
maximum  error  in  total  path-cost  induced  by  cost  coefficient  errors.  This  result  assumes  that  the  solution  path 
uses  regions  of  weight  p.  exclusively.  But,  the  problem  objective  is  to  locate  the  least-cost  path.  So,  the 
occurrence  of  the  maximum  error  is  very  unlikely,  because  good  solutions  will  use  p.  as  infrequently  as 
possible.  For  this  reason,  average  error  will  be  much  lower.  Also,  consider  that  H  may  be  a  positive  or 
negative  deviation.  Unless  cost  coefficient  assignments  are  biased  high  or  low,  errors  will  tend  to  cancel  over 
an  entire  solution  path.  The  effect  on  total  path-cost  may  then  be  minimal. 

From  a  mathematical  perspective  our  algorithm  design  assumes  that  input  maps  are  accurate 
representations  of  the  terrain.  However,  a  probabilistic  approach  assumes  a  more  practical  perspective.  Why 
conduct  an  extensive,  time-consuming  systematic  search  for  an  optimal  solution  whose  accuracy  depends  on 
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the  accuracy  of  the  map?  A  stochastic  algorithm  which  performs  controlled  sampling  can  be  faster, 
particularly  for  larger  problem  instances.  Furthermore,  we  can  design  such  an  algorithm  to  be  less  sensitive 
to  the  accuracy  of  an  input  map.  A  search  guided  by  cost  function  gradients  in  die  space  of  complete  solutions, 
can  make  extensive  use  of  rapid  approximations.  It  can  choose  to  compute  more  carefully  and  accurately  only 
when  sampled  costs  indicate  such  a  computation  might  be  fruitful.  A  systematic  search  can  also  be  guided  by 
cost  gradients.  However,  most  of  its  time  is  spent  examining  partial  solutions.  Cost  gradients  of  complete 
solutions  contain  more  knowledge  than  those  of  partial  solutions. 

b.  Total  Path  Cost 

A  computed  solution  path  cost  may  not  always  be  precise.  Local  optimality  conditions  are 
complex  enough  to  admit  irrational  number  solutions.  As  a  result,  many  computed  path  costs  are  necessarily 
approximations.  Furthermore,  geometric  problems  like  the  WRP  usually  require  many  line  intersections  and 
point  location  procedures.  This  increases  the  likelihood  round-off  errors  due  to  subtractions  between  near 
equal  values  as  happens  in  computing  the  intersection  of  two  near-parallel  lines.  Since  solution  paths  are 
piecewise  linear  between  such  intersection  points,  then  such  round-off  errors  can  accumulate,  widening  the 
gap  between  true  and  computed  total  path  cost.  It  is  often  possible  to  identify  and  replace  such  calculations 
with  more  rational  logic.  For  example,  we  can  identify  a  parallel  condition  to  a  predetermined  precision  (six 
decimal  digits  for  Quintus  Prolog  Version  2.0  [Quin90]),  then  explicidy  select  the  point  of  intersection  rather 
than  compute  it. 

c.  Path  Location 

A  computed  optimal  path  location  (described  by  its  linear  segments)  may  differ  from  the  true 
optimal  path  location.  Such  errors  may  be  so  small  that  the  characteristic  behavior  (for  example,  the  sequence 
of  boundary  edges  crossed  between  start  and  goal)  of  both  computed  and  true  optimal  paths  are  identical.  On 
the  other  hand,  path  location  errors  can  also  be  very  large.  Furthermore,  large  path  location  errors  are 
sometimes  caused  by  relatively  small  errors  in  optimal  path  cost.  The  reason  is  simple.  A  single  WRP  instance 
can  have  two  distincdy  different  solutions  paths  whose  total  weighted  costs  are  equal  and  globally  minimum. 
The  solution  path  returned  by  an  algorithm  will  be  that  for  which  path  cost  was  most  favorable.  Thus,  if  the 
average  error  in  path  cost  is  large  relative  to  precision,  then  more  solutions  have  the  potential  to  be  selected 
as  optimal  due  to  error.  Assuming  that  only  one  in  this  set  is  the  true  optimal,  then  the  probability  of  selecting 
it  is  dependent  upon  the  level  of  noise. 
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3.      Search  Techniques 

There  are  many  ways  to  classify  search  techniques.  Furthermore,  unions  and  intersections  of  these 
methods  form  a  variety  of  combinations.  We  find  it  most  appropriate  to  discuss  search  under  two  general 
categories  -  systematic  and  local.  When  pertinent,  we  also  mention  important  subclasses  and  variants. 

a.     Systematic  Discrete  Search 

Globally  optimal  solutions  of  a  WRP  instance  can  only  be  recognized  by  demonstrating  that 
no  other  feasible  solution  can  have  lower  cost.  This  requires  a  search  strategy  which  is  both  complete  and  non- 
repetitious  [Pear84].  Completeness  says  that  no  optimal  solution  can  be  overlooked.  Non-repetition  precludes 
endless  reevaluation  of  locations  previously  visited  (as  can  happen  in  cyclic  graphs).  In  general,  a  systematic 
search  ensures  both  conditions. 

Uniform  breadth-first  search  is  one  such  complete  strategy  [Barr8 1],  It  expands  from  the  start 
state  in  all  directions  accumulating  cost  at  a  uniform  rate  while  maintaining  a  historical  trail  which  links  every 
child  state  back  to  its  optimal  parent.  There  is  an  implicit  ordering  of  state  expansion.  As  it  is  encountered, 
each  new  state  is  queued  on  an  agenda.  Thus,  a  roughly  circular  search  frontier,  represented  by  the  agenda, 
begins  at  the  start  state  and  gradually  expands  outward  as  the  search  progresses.  Explored  states  are  marked 
as  visited  so  that  they  can  be  identified  if  revisited.  If  a  partial  solution  is  extended  to  a  state  which  was 
reached  earlier,  then  the  historical  data  is  updated  to  point  back  along  the  shorter  approach  path.  A  search  is 
said  to  be  uniform  with  respect  to  cost  if  all  partial  solution  paths  are  extended  by  the  same  cost  increment. 
Uniformity  guarantees  that  the  least-cost  solution  has  been  discovered  as  soon  as  the  goal  is  reached.  There 
are  two  major  drawbacks  to  uniform  breadth-first  search.  First,  it  is  a  blind  search  because  it  does  not  use 
information  about  the  search  space  or  the  problem  instance  to  guide  exploration.  Second,  the  incremental  cost 
step  at  which  node  expansions  must  occur  is  a  function  of  the  lowest  cost  coefficient.  If  the  range  of  cost 
coefficient  values  is  large,  then  the  rate  of  expansion  through  higher-cost  regions  can  be  painfully  slow. 

In  some  problems  execution  times  can  be  reduced  through  bidirectional  search.  In  this 
variant,  a  search  is  conducted  from  both  the  start  and  the  goal  concurrently.  If  each  search  by  itself  is  uniform, 
then  when  a  path  from  the  start  reaches  a  path  from  the  goal,  their  union  is  the  least-cost  solution  path. 
Application  of  this  technique  requires  a  priori  knowledge  of  the  goal  location.  This  being  the  case  in  the 
WRP,  bidirectional  uniform  search  can  be  applied  to  shorten  the  execution  time  [Rich87]. 

Branch-and-bound  is  one  search  variant  which  avoids  some  weaknesses  of  uniform  search. 
This  is  considered  a  form  of  ordered  search  [Barr81],  because  there  is  an  explicit  ordering  of  state 
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expansions  Instead  ol  queuing  Mates,  branch  and  bound  always  expands  the  state  whoso  current 
accumulated  path  cost  is  minimum,  This  ordering  guarantees  thai  an  optimal  solution  has  been  found  when 
.1  |<.iili  to  the  goal  with  a  cost  that  is  equal  (0  01  lowei  than  the  ininiimiin  cost  state  eurrenlly  on  the  agenda 

(i  c  the  next  state  to  be  explored)  is  discovered.  The  first  complete  solution  provides  en  upper  bound  on  the 

K-.isi  nisi  solution  Intermediate  search  nodes:  whose  cost  equals  01  exceeds  this  bound  cannot  result  in  an 
Optimal  solution,  ami.  therefore,  can  be  pruned  from  ilk-  search.  When  the  bounding  mechanism  can  be 
activated,  and  how  effective  it  Will  be,  depends  upon  how  quickly  the  first  solution  is  found  and  how  close  it 
is  u>  optimal   Using  accumulated  path  cost,  branch  and  bound  fOCUSOS  its  attention  on  paths  which  tend  to 

have  more  potential  foi  optimality,  However,  the  measurement  oi  this  potential  is  one-sided  because  it  is 
relative  to  the  start  state  only.  Unfortunate!) .  when  the  search  graph  consists  of  weighted  arcs,  then  expansion 
ol  states  will  not  be  uniform  with  respect  to  cost  Therefore,  branch  end  bound  cannot  employ  bidirectional 
search  to  find  ■  least  cost  solution. 

i*  starch  is  i  heuristic  search  variant  winch  extends  the  concept  ofbranch-and-bound  by 
improving  the  measurement  oi  optimalit)  potential  Bach  state  placed  on  the  agenda  is  rated  by  the  value  oi 

us  f\ ...'•;  [Barr81]   ["he  evaluation  function  is  the  sum  of  the  cost  to  reach  that  state  from  the 

si. in  plus  m  estimated  COSt  from  mat  state  to  the  goal  At  each  Stage  in  the  search,  the  next  state  selected  for 
expansion  is  the  one  which  lias  the  niuuniiini  evaluation,  Furthermore,  if  the  estimate  to  the  goal  is  a 

guaranteed  underestimate,  then  the  search  is  called  odWu  ut  ■ .    Admissibility  guarantees  the  optimality  of  the 

tusi  path  reaching  the  goal   Since  A*  is  more  informed  it  often  demonstrates  marked  improvement  over 

uninformed  strategies  rims,  it  good  cost  underestimates  ire  easy  to  compute,  then  a*  may  be  preferred  over 
branch  ami  bound  and  uniform  breadth  tusi  search. 

Clear!) .  we  desire  to  employ  the  fastest,  most  efficient  search  strategy  available.  Wo  note  that 
both  branch  and  Nnuui  ind  a*  search  elicit  a  puce  for  their  efficiency,  Both  require  the  maintenance  of  an 
ordered  agenda  in  the  form  ol  i  list  oi  heap  Since  in  igenda  contains  the  costs  and  locations  oi  ail  partial 
solutions,  u  cannot  be  truncated  before  it  least  one  complete  solution  has  been  (ouw\  Otherwise,  information 
necessary  to  determine  an  optimal  solution  max  be  lost  Agenda  control  mechanisms  can  become  unwieldy 
foi  large  problems  rhus,  if  i  good  underestimate  of  cost  from  each  state  to  the  goal  is  not  easily  computed, 

oi  is  not  reasonably  close  to  actual  cost,  then  A*  search  may  require  more  computing  resources  than  simpler 
techniques  [Rich87]   From  I  practical  standpoint,  the  best  search  technique  foi  a  given  problem  ultimatelv 

depends  uponanumbci  of  factors  These  include  problem  domain,  representation  scheme,  solution  space,  and 

the  instances  w  e  expect  to  eneountei 
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b.     Local  Iterative  Search 

One  of  the  most  powerful  and  successful  techniques  for  attacking  difficult  combinatorial 
optimization  problems  is  local  search  [Papa82].  In  continuous  function  optimization,  local  search  techniques 
are  referred  to  as  steepest  descent  (minimization)  or  hill-climbing  (maximization)  [BarrSl].  Researchers  have 
applied  these  searches  quite  successfully  to  many  NP-hard  problems  (for  example,  Traveling  Salesman 
Problem  [Lin65]).  They  are  also  valuable  for  some  polynomial-time-solvable  problems.  For  example,  though 
linear  programming  is  polynomially  solvable,  it  can  be  solved  efficiently  and  exactly  by  the  well-known 
Simplex  Algorithm,  which  is  essentially  a  local  search. 

Given  the  set  of  all  feasible  solutions,  F,  local  search  requires  an  initial  solution,/^  e  F,  and 
a  mechanism  for  generating  a  neighborhood,  N,  of  solutions  /..  The  neighborhood  of  a  solution  /  is  a  set 
solutions,/.,  which  are  "close"  to/[Papa82].  In  general,  a  solution/  is  in  the  neighborhood  of/  ,  if  starting 
from/  ,  we  can  obtain/  by  some  small  predetermined  change  to/  .  This  change  (or  changes)  is  usually 
applied  to  some  representation  of  the  solution/  (for  example,  a  simple  swapping  of  two  integers  representing 
ordered  points  in  space).  How  the/  are  generated  determines  the  size  and  content  of  N.  Beginning  from/  ,  a 
local  search  procedure  applies  and  evaluates  perturbations  to  the  current  solution  in  an  attempt  to  find  cost- 
improving  configurations.  In  iterative  improvement  only  cost-improving  perturbations  are  accepted  and  the 
procedure  repeats  until  no  improvement  can  be  found.  At  this  point  the  current  solution  is  locally  optimal  with 
respect  to  its  current  neighborhood.  The  drawback  for  many  problems  is  that  this  local  minimum  may  be  far 
from  the  global  minimum,  with  respect  to  both  cost  and  physical  location. 

If  the  complete  cost  function  of  a  problem  is  convex,  then  local  search  can  always  find  the 
globally  optimal  solution.  A  function  f(x)  is  said  to  be  convex  if  the  following  inequality  holds  for  any  pair 
of  domain  values,  x  and  a:  [Baza77]: 

V  X  e  [0,1]       f{hcl  +  (1-X)x2)  <  X/Up  +  (l-?i)/U2)  (Eq  2.1) 

Convexity  implies  that  a  local  extremum  is  a  global  extremum.  By  successively  searching  the  neighborhood 
of  the  improved  solutions,  a  local  search  procedure  eventually  enters  the  neighborhood  of  the  globally 
optimal  solution.  The  speed  of  approach  depends  on  the  size  of  the  neighborhood,  and  how  quickly  its  local 
minimum  can  be  found.  In  the  worst  case  such  a  procedure  can  be  very  slow.  But  if  the  cost  function  of  the 
solution  space  is  a  convex  function,  then  faster  techniques  such  as  binary  or  Golden  Ratio  search  can  be 
used. 

Not  all  problems  exhibit  the  property  of  convexity.  A  solution  space  may  consist  of  multiple 
local  extrema.  Taken  as  a  whole,  the  solution  space  of  the  WRP  is  not  convex.  However,  recall  that  it  can  be 
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partitioned  into  convex  SUbspaces.  The  cost  of  ihc  local  minimum  in  each  subspacc  can  be  found  by  binary 
Search  and  compared  with  each  other  to  determine  the  global  minimum.  The  difficulty  with  this  is  that  the 
number  Of  path  SUbspaces  is  at  least  0(2V)  where  v  is  the  number  of  vertices.  Either  a  way  must  be  found  to 
organize  these  subspaccs  for  systematic  search,  or  a  local  search  must  be  capable  of  escaping  from  local 
minima. 

A  significant  issue  in  local  search  is  the  configuration  of  a  neighborhood  and,  consequendy, 
how  it  is  generated.  F;or  a  given  neighborhood  structure,  when  a  locally  optimal  solution  is  also  guaranteed 
to  be  globally  optimal,  then  the  neighborhood  is  said  to  be  exact  (Papa82).  If  the  functional  value  of  a  domain 
point  is  belter  than  all  other  domain  points  within  its  neighborhood,  then  die  point  is  locally  optimal.  If  the 
neighborhood  is  exact,  then  this  point  is  also  globally  optimal.  For  a  convex  function,  any  non-empty 
neighborhood  is  exact.  However,  for  a  non-convex  function  this  is  usually  not  true.  Consequently,  only  very 
large  neighborhoods  may  be  exact.  Unfortunately,  in  some  non-convex  problems  the  only  exact 
neighborhoods  contain  all  feasible  solutions  (for  example,  the  Traveling  Salesman  Problem).  In  such  cases 
local  search  will  require  the  same  or  more  work  than  systematic  search.  Therefore,  from  a  practical  point  of 
view,  it  is  sometimes  belter  to  compromise  an  exact  neighborhood  for  an  inexact  one  and  concede  the 
guarantee  Of  global  optimality.  Using  inexact  neighborhoods  we  can  also  search  locally  from  several  initial 
feasible  solutions.  This  can  sometimes  be  more  effective  because  it  lends  to  broaden  search  space  coverage. 
However,  this  does  not  ensure  thai  the  globally  optimal  solution  lies  in  or  can  be  located  from  any 
neighborhood  of  the  initial  solutions  selected. 

Another  important  issue  is  local  search  control,  die  mediod  by  which  a  neighborhood  is 
searched.  One  common  technique,  Steepest  descent  examines  the  entire  neighborhood,  N,  of  some  solution 
and  selects  the  locally  best  solution  within  N.  This  best  solution  has  its  own  corresponding  neighborhood, 
which  is  searched  for  its  local  extremum.  And  the  process  iicratively  repeats  itself.  A  more  expedient  method, 
first-improvement,  searches  the  neighborhood  as  follows.  Given  a  solution,  neighbors  are  examined  randomly 
or  in  some  order  until  the  first  cost-improving  solution  is  found.  This  solution  is  used  as  the  basis  for  the  next 
neighborhood.  These  two  techniques  generally  represent  the  extremes  in  a  spectrum  of  variations  on 

neighborhood  search  [Papa82], 

The  nature  of  the  solution  space  will  likely  influence  die  choice  of  a  specific  control 
procedure.  When  a  neighborhood  structure  is  relatively  small  and  imparls  a  natural  ordering  to  its  solutions, 
then  orderly  examination  of  the  neighborhood  may  be  all  that  is  necessary  to  locate  the  local  opumum. 
\  low  over,  for  some  problems  exact  neighborhoods  may  be  so  large  that  only  partial  search  is  practical.  In  such 
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cases,  random  sampling  within  the  neighborhood  can  be  useful  and  more  efficient.  As  in  systematic  search, 
heuristic  information  can  often  help  to  reduce  local  search.  For  example,  in  his  work  on  the  Traveling 
Salesman  Problem  [Lin65]  recognized  that  it  is  sometimes  possible  to  identify  common  features  of  good 
solutions.  The  heuristic  is  that  some  of  these  features  are  very  likely  contained  in  the  global  optimal  solution. 
To  apply  this  knowledge,  a  local  search  should  tend  to  preserve  these  features  in  subsequent  neighborhoods, 
thereby  reducing  the  overall  search  effort. 

The  steepest  descent  approach  to  the  WRP  would  encounter  difficulty  with  discontinuous 
costs  between  path  subspaces  which  occur  at  region  vertices.  The  convexity  theorem  guarantees  path-cost 
continuity  for  path  subspaces  which  cross  identically  ordered  sequences  of  boundary  edges.  It  does  not  apply 
when  the  sequence  of  edges  crossed  changes,  as  occurs  if  a  path  subspace  includes  a  vertex  joining  regions 
of  unequal  cost  coefficients. 

c.  Relaxation 

Many  optimization  problems  reduce  to  finding  the  solution  which  best  satisfies  a  large  set  of 
conflicting  constraints,  that  is  conditions  required  of  the  solution.  A  search  technique  in  which  constraints  are 
iteratively  added,  removed,  or  replaced  to  improve  a  solution  is  called  relaxation.  The  term  has  been  applied 
to  both  continuous  [Char87]  and  discrete  [Rowe88]  optimization.  We  say  that  a  constraint  is  active  when  it 
is  currently  being  enforced.  Otherwise,  it  is  relaxed.  We  may  begin  from  one  solution  and  activate  one  or 
more  constraints  which  require  that  the  original  solution  be  changed  to  satisfy  the  new  conditions.  Another 
method  begins  by  assuming  that  all  solutions  are  possible.  As  constraints  are  activated,  solutions  which 
cannot  satisfy  them  are  eliminated.  As  more  constraints  become  active  they  may  or  may  not  conflict.  If  they 
do,  it  may  be  necessary  to  backtrack,  relaxing  some  and  activating  others.  The  entire  process  can  be  viewed 
as  a  state  space  search  where  states  are  solutions  satisfying  various  constraint  combinations  and/or  degrees  of 
restriction. 

d.  Probabilistic  Search 

If  neighborhoods  or  problem  instances  are  too  large  for  practical  exploration,  then  a 
probabilistic  approach  to  search  becomes  appealing.  There  are  several  forms  of  probabilistic  algorithms.  A 
Monte  Carlo  algorithm  returns  a  solution  which  has  some  probability  of  being  correct.  A  Las  Vegas  algorithm 
always  finds  a  correct  solution,  but  may  require  multiple  executions  to  do  so  [Bras88].  Another  form  of 
probabilistic  algorithm  estimates  a  solution  when  an  exact  solution  is  not  possible  or  is  impractical. 
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Our  approach  10  solving  the  WRP  lends  toward  probabilistic  estimation.  We  rapidly  sample 
locally  optimal  solutions  randomly  by  moving  through  neighborhoods  consisting  of  convex  path  subspaces. 
The  cost  of  a  SUbsptce  is  the  cost  of  iLs  locally  optimal  path.  Cumulatively,  the  sampling  covers  a  broad  area 
of  the  solution  space.  Probability  focuses  local  se;uvh  on  die  neighborhoods  with  greater  potential  for 
containing  an  optimal  path.  Gradually,  we  reduce  the  ability  of  die  algorithm  to  sample  across  a  broad  range 
o(  path  suhspaccs.  11ns  is  done  by  decreasing  the  pa>bability  of  movement  to  cost -increasing  solutions. 
Inevitably,  the  probability  constraints  lighten  to  die  point  of  preventing  movement  to  all  but  cost-improving 
solutions.  When  all  cost  improvements  have  been  applied,  the  algorithm  halls  and  delivers  its  best  known 
solution, 

While  probabilistic  algorithms  cannot  guarantee  globally  optimal  solutions,  the  practical 

advantages  can  he  significant.  Probabilistic  algorithms  are  inherently  nondeterministic.  Two  execution 

sequences  on  the  same  problem  instance  will  almost  never  be  identical,  although  the  final  solutions  can  often 
be  the  same.  Such  behavior  implies  that  For  a  given  problem  si/e  algorithm  performance  does  not  depend  on 
a  specific  problem  instance.  In  probabilistic  algorithms  <  tpected  tunc  of  execution  replaces  average  execution 
time  over  all  possible  instances  of  a  particular  si/e.  For  a  given  problem  si/e,  expected  execution  time  is  the 
same  for  all  problem  instances  -  worst  cases  included.  In  this  sense,  one  can  argue  that  probabilistic 
algorithms  can  exhibit  more  predictable  performance  than  deterministic  ones. 

A  typical  behavior  Of  many  probabilistic  algorithms  is  that  the  quality  of  their  final  solutions 
can  improve  over  time.  This  can  be  a  significant  advantage  when  time  resources  are  uncertain.  Such 
algorithms  might  be  terminated  prematurely  and  still  return  an  adequate  result.  The  most  obvious  time 
advantage  occurs  because  a  probabilistic  algorithm  merely  samples  us  solution  space  and  uses  Statistics  and 
heuristics  to  interpolate  and  inter  know  ledge.  Often  global  or  near-global  optima  can  be  found  in  significantly 
less  computing  time.  Thus,  a  relatively  small  sacrifice  in  solution  quality  can  deliver  a  disproportionately 
large  increase  in  efficiency 

B,      APPROACHES  TO  THE  GENERAL  WEIGHTED  REGION  PROBLEM 

1.       Grid-Based  Wavefront  Propagation 

Wavefront  pre»pagation  is  an  approximating  method  which  employs  a  modified  branch-  and  -hound 

search.  An  orthogonal  grid  of  predetermined  resolution  overlays  a  weighted-region  map.  Each  grid  cell  is 
assigned  a  cost  coefficient.  There  arc-  at  least  two  ways  to  do  this.  We  could  use  the  homogeneous-cost 
Coefficient  of  the  region  occupying  the  greatest  area  within  die  cell.  We  could  also  take  the  average  cost 
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coefficient  weighted  by  the  percentage  of  its  area  in  the  cell.  The  search  begins  from  the  grid  cell  containing 
the  start  point  and  continues  until  the  cell  containing  the  goal  point  is  reached.  A  trail  of  back  pointers  permits 
optimal  path  retrieval.  An  agenda  maintains  the  wave  frontier  and  associated  back  pointers.  Although  simple, 
the  algorithm  has  three  major  drawbacks.  First,  it  is  a  blind  search.  Thus,  without  heuristics,  it  is  painfully 
slow,  particularly  if  the  range  of  cost  coefficients  is  large.  Second,  even  maps  with  a  few  regions  may  require 
a  relatively  high  resolution  grid  to  accurately  represent  detail.  Each  cell  of  die  grid  is  essentially  a  node  in  the 
search  graph.  Increasing  the  resolution  of  the  grid  by  factor  R  roughly  induces  an  fc  increase  in  the  number 
of  search  nodes,  and,  consequently,  the  size  of  the  problem  instance.  Third,  fixing  paths  to  a  grid  causes  "stair- 
step" solution  paths.  Assuming  that  resolution  is  fine  enough  to  capture  all  terrain  features  modeled  by  the 
weighted-region  map,  an  8-neighbor  implementation,  may  return  solutions  which  are  as  much  as  8%  greater 
than  optimal.  Nevertheless,  digital  bias  can  be  reduced  [Mitc84],  and  heuristics  can  improve  efficiency  to 
some  degree  [Rich87]. 

2.      Snell's  Law 

More  accurate  approaches  to  solving  the  WRP  use  Snell's  Law  as  a  local  optimization  criterion. 
Recall  that  cost  regions  are  homogeneous.  Thus,  by  the  triangle  inequality,  optimal  paths  cannot  turn  at 
interior  points  of  cost  regions.  It  follows  that  turning  points  may  occur  where  cost  changes  abrupUy,  that  is, 
at  cost  region  boundary  edges. 

Snell's  Law  defines  the  optimality  conditions  for  such  turns.  Given  a  fixed  point  in  each  of  two 
adjacent  regions,  the  least  cost  path  between  them  always  satisfies  the  conditions  of  Figure  2.2,  where  6  and 
0  are  region  cost  coefficients.  This  relation  is  analogous  to  that  used  in  optics  to  determine  how  a  light  ray 
will  bend  when  it  passes  between  two  media  with  different  refraction  indexes. 
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Figure  2.2     Snell's  Law  Optimally  Criterion 

The  optical  analogy  is  less  applicable  in  the  limiting  case  of  reflection.  Figure  2.3  illustrates  the 
special  case  of  a  crossing  episode  which  occurs  at  the  Snell's  Law  critical  angle  associated  with  the  higher 
cost  region.  An  optical  light  ray  reflects  back  into  the  medium  from  which  it  came  when  its  angle  of  incidence 
exceeds  the  critical  angle.  Such  a  path  would  not  be  optimal  in  the  WRP.  To  preserve  optimality  requires  that 
the  path  move  parallel  and  infinitesimally  close  to  the  boundary  edge  on  the  low  cost  side.  Thus,  the  path 
incurs  the  lower  cost  per  unit  distance  of  travel  on  the  edge. 
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Previous  research  suggests  that  Snell's  Law  is  a  powerful  concept  for  the  WRP.  However,  there 
are  also  some  limitations  and  difficulties  with  its  use.  Snell's  Law  defines  local  optimization  criteria  only.  It 
is  a  necessary  but  not  sufficient  condition  for  optimality  at  boundary  crossings.  Therefore,  a  globally  optimal 
solution  path  must  obey  Snell's  Law  at  every  boundary  crossing  episode  (except  at  vertices).  However,  a  path 
which  satisfies  Snell's  Law  at  every  crossing  episode  is  not  guaranteed  to  be  globally  optimal.  Depending 
upon  how  it  is  used,  the  relation  may  not  be  convenient  to  compute.  While  Snell's  Law  can  compute  required 
angles  directly,  there  is  no  closed  form  for  computing  the  coordinates  of  crossing  points.  Furthermore,  it 
involves  the  sine  function  (or  square  roots  in  other  forms),  a  relatively  primitive  but  expensive  operation. 

3.  Continuous  Dijkstra  Algorithm 

The  continuous  Dijkstra  algorithm  [Mitc90]  propagates  Snell's  Law  constraint  intervals  in  all 
directions  from  the  start  A  branch-and-bound  procedure  searches  the  graph  representing  these  intervals.  This 
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algorithm  finds  the  true  optimal  path,  and  establishes  a  worst  case  0(v  L)  time  complexity  and  0(v  )  space 
complexity  (where  v  is  the  number  of  region  vertices  and  L  is  the  number  of  bits  used  to  represent  input). 
While  establishing  that  the  WRP  is  polynomially  solvable,  the  algorithm's  current  lack  of  implementation 
prevents  practical  comparison.  Indeed,  its  seventh-degree-polynomial-timc  complexity  and  its  requirement 
for  triangulated  cost  regions,  suggest  that  it  will  have  relatively  large  average  execution  times. 

4.  Recursive  Wedge  Decomposition  Algorithm 

Another  algorithm  which  finds  an  optimal  path  to  the  WRP  is  the  recursive  wedge  decomposition 
algorithm  implemented  by  [Rowe90b].  The  algorithm  propagates  well-behaved  sets  of  paths  (referred  to  as 
wedges)  from  the  start  point,  and  recursively  expands  and  refines  them  to  construct  a  graph  of  shortest  paths. 
These  wedges  are  similar  to  the  constraint  intervals  in  [Mitc90].  A  prototype  implementation  has 
demonstrated  0(v  )  average  time  complexity  for  relatively  simple  terrain  (although  worst  case  is  still 
exponential).  The  algorithm  tends  toward  its  exponential  worst  case  when  a  large  number  of  wedges  overlap 
the  goal  [Rich87].  It  is  a  very  complicated  algorithm  which  uses  trigonometric  functions  for  many  heading 
and  visibility  computations.  Furthermore,  its  recursive  nature  can  magnify  the  effects  of  these  computations 
and  increase  the  amount  of  agenda  maintenance  necessary  as  the  size  of  a  problem  instance  expands. 
Although,  pruning  heuristics  do  help  to  control  these  effects.  The  empirical  performance  of  this  algorithm  in 
more  complex  terrain  maps  (with  a  wide  range  of  cost  coefficients  and  many  contiguous  regions)  is  unknown. 


21 


5.  Local,  Asynchronous,  Iterative,  and  Parallel  Procedures  (LAIPP) 

The  only  known  work  that  does  not  use  some  type  of  systematic  search  is  [Smit88].  The  Local, 
Asynchronous,  Iterative,  and  Parallel  Procedures  (LAIPP)  approach  is  a  form  of  relaxation.  It  is  similar  to  a 
neural  network  simulation  executed  on  a  single  processor  system.  A  hypothetical  processor  is  assumed  at  each 
boundary  edge  of  the  map.  A  boundary  edge  faces  the  two  regions  it  borders.  Its  associated  processor 
communicates  with  each  processor  assigned  to  the  other  boundary  edges  of  the  two  regions  it  faces.  Each 
processor  tracks  the  locations  of  several  path  crossing  points  on  its  edge.  For  each  point,  the  processor  records 
what  it  believes  is  correct  local  and  global  weighted  distance  data  relative  to  start  and  goal.  The  processors 
iteratively  and  asynchronously  exchange  and  modify  the  data.  Eventually  all  processors  converge  to  an 
agreement  on  locally  and  globally  optimal  path  data.  At  least  one  serial  set  of  processors  from  start  to  goal 
has  recorded  identical  (within  tolerance)  lengths  for  the  solution  path  on  which  they  lie.  A  systematic  search 
of  the  discrete  graph  defined  by  serial  chains  of  agreeing  processors  is  searched  for  the  shortest  such  path  from 
start  to  goal.  Although  empirical  results  indicate  that  the  procedure  often  converges  to  an  exact  globally 
optimal  path,  it  is  not  guaranteed  to  do  so.  Furthermore,  many  locally  minimal  paths  can  be  far  from  optimum. 
The  empirical  time  complexity  is  measured  as  the  number  of  iterations  required  for  convergence  to  processor 
agreement.  This  complexity  is  slightly  more  than  linear  as  a  function  of  Euclidean  path  length.  Time 
complexity  is  also  dependent  upon  the  range  of  cost  coefficients  used.  LAIPP  is  an  interesting  and  promising 
approach  which  we  believe  will  prove  most  valuable  in  a  parallel  processing  environment. 

6.  Optimal-Path  Maps 

An  interesting  approach  proposed  by  [Alex90]  attempts  to  solve  a  large  number  of  WRP  instances 
at  once.  For  a  single  goal  point  location  and  the  geometry  of  weighted  regions,  the  plane  can  be  partitioned 
into  behavioral  regions.  These  are  areas  in  which  optimal  paths  from  all  other  points  behave  in  a  similar 
manner.  For  example,  all  optimal  paths  from  start  points  in  a  given  partition  might  travel  directly  to  and  pass 
through  the  same  weighted  region  vertex  enroute  to  the  goal.  Given  enough  preprocessing  time,  complete 
optimal  path  maps  can  be  constructed.  An  efficient  storage  scheme  will  enable  fast  subsequent  computing  of 
any  optimal  path. 

Two  different  approaches  are  proposed  for  constructing  behavioral  regions.  The  first  is  a 
specialized  grid-based  wavefront  propagation  algorithm  modified  to  recognize  points  on  behavioral  region 
boundaries.  These  are  recognized  as  the  locations  of  wavefront  convergence,  points  from  which  two  (or  more) 


22 


distinctly  different  paths  exist  which  return  to  the  goal  at  identical  costs.  This  algorithm  suffers  from  the  usual 
inefficiencies  and  inaccuracies  associated  with  grid-based  wavefront  propagation. 

The  second  approach  is  an  elegant  application  of  computational  geometry.  It  is  based  on  the 
observation  that  in  a  constant  weighted  plane  (i.e.  a  single  cost  coefficient  on  the  entire  map)  the  optimal-path 
cost  function  originating  from  a  common  goal  sweeps  the  surface  of  a  perfect  cone.  The  introduction  of 
weighted  regions  perturbs  this  cost  function,  and,  thus,  the  shape  of  this  cone.  In  simple  maps,  the  behavioral 
region  boundaries  formed  by  these  perturbations  can  be  computed  as  straight  lines  and  conic  section  curves. 
The  algorithm  applies  complicated  parametric  equations  to  find  the  conic  curves.  The  computations  are 
tedious  and  expensive,  but  the  result  is  a  complete  and  concise  optimal  path  map  from  a  given  start  (goal)  to 
any  goal  (start)  point  desired. 

To  determine  behavioral  regions  more  efficiently,  [Rowe90e]  suggests  modifications  to  the 
recursive  wedge  decomposition  algorithm  of  [Rich87].  The  algorithm's  A*  search  strategy  can  be  exploited 
to  recursively  partition  a  map  into  a  tree  of  wedges  rooted  at  the  designated  start  point.  A  few  conditions 
determine  the  possible  locations  of  overlapping  wedges.  Standard  polygon-intersection  procedures  can  check 
these  wedges  for  true  overlap,  and,  if  found,  establish  the  shape  of  conic  behavioral  region  boundaries  therein. 
A  prototype  of  this  algorithm  is  currently  under  development.  While  this  algorithm  builds  optimal-path  maps 
more  efficiently  than  those  of  [Alex90],  the  time  investment  is  too  costly  for  single  start-to-goal  paths. 

Ideas  presented  in  this  dissertation  could  be  used  to  improve  the  retrieval  of  optimal  paths  from 
the  optimal-path-map  storage  structure  proposed  in  [Alex90].  An  optimal-path  map  is  stored  as  tree  of 
behavioral  regions  which  are  linked  back  to  a  common  goal  point  (the  tree  root)  by  the  vertices  and  boundary 
edges  through  which  optimal  paths  must  pass.  Given  a  start  point,  its  associated  optimal  path  to  the  goal  is 
found  by  tracing  the  ordered  sequence  of  edges  and  vertices  which  are  its  ancestors  in  the  tree.  This  sequence 
may  require  some  limited  optimization  to  obtain  the  exact  path.  Methods  presented  in  this  work  can  perform 
this  optimization  efficiently. 

7.      Minimum-Energy  Paths 

The  work  of  [Ross89]  and  [Rowe90c]  established  a  model  for  finding  minimum-energy  paths  over 
terrain  modeled  by  disjoint  polygonal  regions  representing  constant-slope  surfaces.  Such  a  terrain  model  is 
sometimes  said  to  represent  2-1/2  dimensions  because  freedom  of  movement  is  restricted  to  a  3  dimensional 
surface.  Follow-on  work  [Rowe90e]  proposes  an  integration  of  both  this  model  and  concepts  developed  in 
[Rich87].  This  research  extends  the  generalized  WRP  to  incorporate  anisotropic  homogeneous-cost  regions. 
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The  proposed  unified  algorithm  solves  a  WRP  in  the  2-1/2  dimensional  terrain  model  where  region  weights 
arc  coefficients  of  friction.  An  optimal  solution  in  this  problem  is  the  minimum  energy  path  from  start  to  goal 
(or  minimum  time-travel  path  under  constant  power). 

The  original  implementation  of  the  algorithm  partitions  the  map  representation  into  subspaces  in 
which  families  of  paths  exist.  Our  approach  to  the  WRP  uses  a  similar  partitioning  of  the  map.  However,  all 
of  our  WRP  subspaces  are  naturally  bounded  by  vertices  and  boundary  edges.  The  model  of  [Ross89]  requires 
the  additional  consideration  of  directional  constraints  which  may  further  restrict  the  shapes  and  limits  of 
subspaces.  These  constraints  must  be  examined  and  correlated  in  order  to  form  complete  path  subspaces  from 
start  to  goal.  This  additional  complexity  is  absent  from  the  two-dimensional  isotropic  WRP. 

C.      SPECIAL  CASES  OF  THE  WEIGHTED  REGION  PROBLEM 

Some  applications  may  only  require  an  easily  solved  special  case  of  the  WRP.  We  briefly  consider  two 
algorithms  designed  to  solve  instances  in  which  terrain  features  representation  is  restricted.  The  algorithms 
arc  similar  in  that  each  constructs  a  form  of  discrete  visibility  graph  from  spatial  constraints.  The  concept  of 
visibility  occurs  often  in  movement  planning.  While  its  meaning  may  vary  with  problem  context,  visibility 
generally  implies  that  at  least  one  unobstructed-straight-line  path  exists  between  two  points  on  a  map.  As  the 
following  special  cases  indicate,  visibility  analysis  can  often  derive  many  powerful  constraints  on  optimal 
paths. 

1.      Infinity,  Zero-cost  Regions,  and  Roads 

The  algorithm  in  [Mitc87]  solves  a  special  case  WRP  in  which  we  restrict  terrain  features  to  four 
types:  background,  zero-cost  regions,  roads,  and  obstacles.  As  usual,  obstacles  are  non-traversable  areas  of 
infinite  cosL  Zero-cost  regions  arc  areas  in  which  travel  incurs  negligible  cost  regardless  of  distance 
(essentially,  movement  at  infinite  speed).  Cost  per  unit  distance  in  background  terrain  is  taken  as  one. 
Although  fixed,  this  value  can  be  arbitrary.  Roads  are  stricdy  linear  features  whose  cost  per  unit  distance  is 
less  than  background  cost.  Given  a  start  and  goal,  the  algorithm  computes  a  special  visibility  graph  of  all 
possible  optimal  path  locations.  These  locations  are  determined  through  visibility  analysis  between  vertices, 
and  by  applying  the  Sncll's  Law  local  optimality  criterion.  The  resulting  graph  is  provably  finite,  and  can  be 
searched  using  standard  graph  search  techniques.  The  algorithm  has  worst  case  0(n  logn)  time  complexity, 
where  n  is  the  number  of  feature  vertices.  This  is  a  significant  improvement  over  the  seventh-degree- 
polynomial  lime  complexity  of  the  continuous  Dijkstra  algorithm. 
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Our  approach  to  the  generalized  WRP  makes  an  important  assumption  related  to  visibility  about 
the  input  map.  The  fact  that  all  regions  are  convex  (or  can  be  made  so  with  additional  boundary  edges)  means 
that  all  edges  bounding  a  given  region  are  completely  visible  to  one  another  without  further  calculation.  This 
removes  the  need  for  visibility  analysis  between  end  points  of  path  segments. 

2.      Roads,  Rivers,  and  Rocks  Algorithm 

Additional  work  by  [Rowe90a]  extends  the  foregoing  ideas  to  rivers,  linear  features  with  a  higher 
cost  than  background  terrain.  While  the  work  does  not  consider  zero-cost  regions,  it  is  a  valuable  extension 
because  roads,  rivers,  and  obstacles  can  model  a  great  number  of  commonly  encountered  terrain  situations. 
Proof  is  given  that  optimal  paths  can  only  cross  rivers  at  single  points  and,  unlike  roads,  will  never  travel  on 
them.  Since  the  width  of  a  linear  feature  is  zero,  then  each  river  crossing  episode  incurs  a  fixed  value,  k,  which 
is  added  direcdy  to  total  path  cost.  The  RRR  (Rocks,  Rivers,  Roads)  program  is  a  Prolog  implementation  of 
the  algorithm.  RRR  develops  a  special  visibility  graph  similar  to  that  in  [Mitc90].  As  a  result,  worst  case  time 
complexity  remains  0(n  logn).  However,  RRR  also  uses  several  spatial  heuristics  along  with  A*  search  to 
improve  average  case  performance.  The  so-called  shortcut  meta-heuristic  [Rowe90a]  is  proposed  as  the 
unifying  concept  for  all  optimal  path  constraints.  Related  to  the  optimality  principle,  the  Shortcut  Meta- 
Heuristic  simply  implies  that  a  turning  point  on  an  optimal  path  can  never  be  improved  by  shortcutting  the 
turn.  In  our  own  work,  we  employ  this  concept  to  generalize  optimal  path  constraints  between  regional 
boundary  edges.  Such  constraints  were  first  applied  in  limited  form  as  heuristics  by  [Rich87]. 

D.      SIMULATED  ANNEALING 

Simulated  annealing  is  a  search  technique  based  upon  the  Metropolis  Algorithm  [Metr53],  which 
simulates  a  complex  system  of  particles  (molecules)  in  a  heat  bath.  Recognizing  concepts  similar  to 
optimization,  [Kirk83]  and  [Cern85]  independently  developed  simulated  annealing.  Since  then,  many 
researchers  have  used  it  to  obtain  solutions  to  a  variety  of  combinatorial  optimization  problems. 

1.      The  Basic  Annealing  Algorithm 

In  its  simplest  form,  simulated  annealing  requires  the  five  basic  components  described  in  Figure 
2.4.  Starting  from  the  initial  solution  and  its  evaluated  cost,  a  move  generator  randomly  perturbs  this  solution 
to  obtain  a  new  neighboring  solution.  The  cost  function  of  the  new  solution  is  computed  and  compared  to  the 
cost  of  the  current  solution.  The  new  soludon  always  becomes  the  current  soludon  if  the  change  in  cost,  AC, 
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is  an  improvement.  Otherwise,  the  new  solution  becomes  the  current  with  probability  P=exp(-ACfT).  Figure 
2.5  shows  the  form  of  the  algorithm  we  use  in  mis  work  [Pres88]. 


1.  Solution  space  definition 

2.  S  -  Initial  solution  taken  from  the  solution  space 

3.  Move  generator  to  randomly  generate  small  perturbations  in 
solutions,  thereby  inducing  a  neighborhood  structure  to  the 
search  space 

4.  C(S}  -  Cost  function  which  can  be  evaluated  for  each  solution 

5.  Annealing  schedule  to  provide  algorithm  control: 

TQ  Initial  value  of  T 

T.  Freezing  value  of  T 

R  Reduction  factor  for  T(typically  0.70  <  R <  0.99) 

L  Maximum  number  of  attempted  moves  at  T 

L  Maximum  number  of  accepted  moves  at  T 


Figure  2.4     Basic  Components  of  Simulated  Annealing 


initialize  CURRENT  starting  solution 
initialize  T  :=  T0        /*  T0  starting  temperature  */ 
while  (T  >  Tf)  do       /*  until  T  reaches  Tf  freezing  value  */ 
for  i  :=  1  to  L         /*  for  L  attempted  transitions  */ 
perturb  CURRENT  to  generate  NEW  solution 
AC  :=  cost(NEW)  -  cost(CURRENT) 
if  (AC  <  0) 

then  CURRENT  :=  NEW 
else  CURRENT  :=  NEW  with  P  =  exp(-AC/T) 
end  for 

T  :=  R  *  T  /*  decrement  T  by  reduction  factor  R  */ 

end  while 
return  CURRENT  solution 


Figure  2.5      Standard  Simulated  Annealing  Algorithm 
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The  control  temperature,  T,  is  a  value  in  the  same  units  as  the  cost  function.  It  regulates  the 
probability  distribution  that  defines  the  acceptance  criteria  of  solutions  with  degrading  costs.  At  each 
temperature,  T,  the  procedure  attempts  up  to  L  moves  of  which  up  to  L  acceptances  are  permitted.  Then,  the 
temperature  is  reduced  by  a  factor  R ,  and  both  L  and  L  are  reset.  The  resulting  behavior  is  a  downward-biased 
random  walk  through  the  solution  space,  with  some  ability  to  escape  local  minima.  Referring  to  Figure  2.6, 
it  is  easy  to  see  that  gradually  decreasing  control  temperature  changes  the  exponential  probability  distribution, 
tightening  the  acceptance  criteria  against  larger  cost  increases.  The  value  of  T  for  which  no  cost  increases  are 
reasonably  expected  and  no  more  improvements  can  be  found  is  called  the  freezing  temperature,  T  At  this 
stage  the  algorithm  returns  the  most  current  solution,  and  halts.  As  an  added  advantage,  the  algorithm  can  also 
maintain  the  best  known  solution  and  return  this  if  it  is  better  than  the  final  current  solution. 
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Figure  2.6      Probability  of  Acceptance  vs  Cost  Difference  AC 
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To  enhance  the  performance  of  the  basic  annealing  algorithm,  researchers  have  developed  and 
tested  a  variety  of  improvement  techniques  and  heuristics.  All  of  these  methods  are  concerned  with  one  or 
more  of  the  basic  annealing  components.  Since  the  focus  of  our  work  is  in  solving  the  WRP  using  annealing 
as  a  tool,  we  defer  discussion  of  enhancements  to  Chapter  IV.  To  the  best  of  our  knowledge,  the  work  of  this 
dissertation  is  the  first  (and  only)  investigation  of  a  simulated  annealing  algorithm  to  solve  the  WRP. 

In  the  sections  which  follow,  we  review  some  of  the  previous  annealing  work  applied  to  problems 
with  a  path-planning  flavor  bearing  some  resemblance  to  the  WRP.  Our  objective  is  to  identify  and  discuss 
similarities  and  differences  between  these  problems  and  the  WRP  as  they  relate  to  annealing.  For  annealing 
work  on  other  problems  and  applications,  [C0II88]  gives  an  extensive  annotated  bibliography  of  simulated 
annealing  theory  and  applications. 

2.       Routing  Applications  of  Annealing 

a.      The  Traveling  Salesman  Problem  (TSP) 

The  classical  Traveling  Salesman  Problem  (TSP)  is  arguably  one  of  the  most  investigated 
problems  on  record.  Because  it  is  NP-Complete,  large  instances  of  the  TSP  are  likely  to  be  intractable  and 
require  approximating  algorithms  to  estimate  the  optimal  solution.  As  a  result,  many  researchers  have 
explored  annealing  solutions  to  it.  In  addition  to  the  original  work  of  [Kirk83]  and  [Cern85],  [C0II88]  lists  40 
references  to  annealing  work  on  the  TSP.  Most  of  this  work  uses  the  TSP  as  a  vehicle  to  investigate  properties 
and  enhancements  to  the  annealing  algorithm  itself.  While  both  TSP  and  WRP  are  essentially  routing 
problems  in  two-dimensional  Euclidean  space,  there  exist  significant  differences  which  impact  on  the 
annealing  approach. 

The  TSP  admits  a  fairly  straight  forward  annealing  approach.  In  its  classic  form,  a  TSP 
instance  consists  of  a  finite  set  of  discrete  points  in  a  two-dimensional  plane.  The  optimal  solution  is  a 
piecewisc  linear  least-cost  path  which  connects  every  discrete  point  with  a  straight-line  path  segment.  The 
entire  path  forms  a  closed  cycle.  Thus,  every  feasible  solution  is  well-defined,  includes  every  input  point 
once,  and  has  a  cost  which  is  almost  precisely  determinable.  These  three  aspects  of  the  TSP  make  it  an 
excellent  annealing  application.  Solutions  are  nothing  more  than  a  fixed-length  ordered  set  of  points.  A 
solution  cost  is  the  sum  of  Euclidean  distances  between  ordered  points.  The  move  generator  for  the  annealing 
algorithm  is  simple  and  efficient.  To  generate  a  new  feasible  solution,  permute  the  point  ordering  of  the 
current  solution. 
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In  contrast,  an  annealing  approach  to  the  WRP  is  more  difficult.  A  problem  instance  is  a  map 
of  regions,  associated  cost  coefficients,  and  designated  start  and  goal  points.  The  number  of  feasible  solutions 
between  start  and  goal  is  uncountably  infinite.  Fortunately,  the  convexity  of  the  Snell's  Law  optimality 
criterion  can  partition  the  solution  space  into  a  finite  number  of  discrete  path  subspaces  (recall  the  wedges  in 
[Rich87]).  Even  so,  computation  of  a  single  cost  for  each  subset  of  paths  can  be  expensive  and  highly 
dependent  upon  desired  precision  [Mitc90].  WRP  feasible  solutions  usually  consist  of  some  subset  of 
problem  input;  generation  of  new  feasible  solutions  is  not  as  simple  as  permuting  a  fixed-length  lisL  Finally, 
recall  that  annealing  requires  an  initial  soluuon  to  begin.  While  a  TSP  initial  solution  is  any  ordering  of  the 
input,  such  is  not  the  case  for  the  WRP.  A  straight  line  path  from  start  to  goal  is  not  guaranteed  to  be  feasible 
in  the  presence  of  infinite  cost  regions.  Thus,  we  must  also  resort  to  a  more  sophisticated  method  to  initiate 
annealing  for  the  WRP. 

An  annealing-based  algorithm  to  solve  a  more  general  variation  of  the  TSP  is  presented  in 
[Adam85].  The  problem  is  to  plan  an  ordered  cyclic  route  from  a  given  starting  point  to  a  subset  of 
predetermined  locations  on  a  two-dimensional  map.  The  objective  cost  function  is  considerably  more 
complex  than  simple  Euclidean  distance.  Each  location  i  has  a  corresponding  value  V.  which  measures  its 
worth  to  the  overall  plan.  Subgoal  values  V.  can  be  dependent  upon  time  and  interdependent  upon  order  of 
arrival.  The  objective  function  also  employs  the  conditional  probability,  P[G.\S],  of  reaching  a  subgoal  i, 
given  that  the  plan  j  is  pursued  and  given  the  current  state  S  of  the  autonomous  vehicle  (e.g.  fuel  supply, 
weapons  status)  and  its  working  environment.  Constraints  of  minimum  acceptable  probabilities  and  minimum 
time  required  to  reach  particular  subgoals  may  also  factor  into  the  cost  of  a  plan.  The  algorithm  searches  for 
a  plan  which  maximizes  overall  utility  defined  as: 

U:=  yL(PiG.\S]Vij)  (Eq2.2) 

ij 

One  similarity  between  this  problem  and  the  WRP  concerns  cost  function  evaluation.  Recall 
that  in  annealing,  cost  function  comparisons  between  solutions  drive  and  guide  the  process.  Clearly,  exact 
evaluation  of  each  feasible  solution  is  not  reasonable  in  the  algorithm  of  [Adam85].  Instead,  the  authors  adopt 
a  Monte  Carlo  method  to  approximate  the  cost  of  each  soluuon,  which  significantly  increases  algorithm 
efficiency.  A  similar  time-saving  technique  suggested  by  [Tove88]  is  the  surrogate  function  swindle.  If  a  cost 
function  is  difficult  to  evaluate,  substitute  one  which  is  easier  and  approximates  the  original.  In  the  WRP, 
Snell's  Law  enables  us  to  compute  locally  optimal  path  costs.  However  the  nature  of  Snell's  Law  makes  the 
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procedures  for  doing  so  relatively  expensive.  Consequently,  we  approximate  their  costs  as  often  as  possible, 
reserving  the  more  precise  computations  only  when  absolutely  necessary. 

b.      Wire  Routing  and  Chip  Placement 

The  design  of  very-large-scale  integrated  circuit  boards  requires  the  optimal  placement  of 
solid  state  chips  and  associated  wire  connections.  Simulated  annealing  has  been  successfully  used  in  the  chip 
placement  problem  [Grov86,  Sech86],  a  direct  descendent  of  the  NP-complete  bin  packing  problem.  Global 
wire  routing  is  a  path  optimization  problem  somewhat  closer  in  similarity  to  the  WRP.  While  the  problem 
context  is  a  two-dimensional  plane,  wire  routing  solutions  are  usually  drawn  from  a  discrete  space  of 
predetermined  routes.  Ordinarily,  an  optimal  arrangement  of  components  predetermines  all  terminal  points 
for  connecting  wires.  An  optimal  routing  of  wires  required  between  all  terminal  pairs  minimizes  total  distance 
and  the  number  of  bends  and  overlaps  [Vech83].  In  global  wire  routing,  the  routes  are  normally  confined  to 
the  orthogonal  channels  between  components,  so  that  the  Manhattan  distance  metric  applies  and  the  solution 
space  is  discrete.  Also,  there  is  usually  some  upper  bound  constraint  on  the  overlap  capacity  of  each  channel 
(i.e.  the  maximum  allowable  number  of  tracks  per  channel). 

Like  the  Traveling  Salesman  Problem,  the  global  wire  routing  problem  lacks  the  continuous 
space  aspect  that  complicates  the  WRP.  However,  wire  routing  exhibits  a  more  complicated  objective 
function.  The  objective  function  of  [Vech83]  attempts  to  model  all  constraints  simultaneously.  Annealing  is 
conducted  in  two  stages.  The  first  permits  only  L-shaped  paths  (single  bend)  between  terminal  points.  The 
second  stage  begins  at  the  temperature  from  the  last  state  of  stage  one,  and  includes  both  L  and  Z-shaped  paths 
(two  bends).  Staging  the  optimization  in  two  shifts  reduces  overall  computing  time  yet  achieves  results 
comparable  to  those  obtained  when  both  path  types  are  sampled  throughout  the  entire  annealing  process. 
Similarly,  [Sech86]  employs  a  two-stage  approach.  However,  the  first  stage  is  a  non-annealing  algorithm 
which  selects  wiring  configurations  that  minimize  only  total  distance.  The  second  stage  uses  annealing  to 
minimize  total  wire  overlap  by  searching  through  the  choices  made  by  the  first  stage.  Again,  the  result  is 
savings  of  time. 

A  multi-stage  approach  is  often  applied  to  difficult  problems.  The  strategy  attempts  to 
identify  high-level  characteristics  common  to  most  optimal  or  near-optimal  solutions  (for  example,  general 
shapes,  common  placements,  etc.)  that  can  later  guide  development  and  optimization  of  a  more  detailed 
solution.  This  strategy  is  formalized  in  [Whit84]  by  relating  the  scaling  of  moves  to  annealing  temperature. 
At  higher  temperatures,  larger  random  moves  through  the  solution  space  arc  more  efficient  than  smaller 
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moves.  Detailed  solution  improvements  are  discovered  at  lower  temperatures,  when  smaller  moves  are  most 
efficient.  In  this  sense,  simulated  annealing  develops  a  solution  in  a  top-down  manner.  Evidently,  because  of 
this  similarity,  multi-staging  seems  to  be  a  good  general -purpose  annealing  heuristic. 

Closely  related  to  multiple  stages  is  concept  of  the  target  prejudice  swindle  suggested  by 
[Tove88].  This  applies  when  general  characteristics  or  properties  of  optimal  solutions  are  known.  The 
annealing  process  often  saves  time  if  the  the  move  generator  can  be  biased  to  generate  neighbors  with  optimal 
solution  characteristics.  For  example,  in  the  WRP  we  know  that  optimal  solutions  never  have  cycles. 
Therefore,  we  should  avoid  generating  such  paths.  In  the  extreme  sense,  this  is  what  [Vech83]  has  done  by 
biasing  his  first  stage  exclusively  toward  L-shaped  paths.  Another  simple  way  to  get  the  effect  of  the  target 
prejudice  swindle  heuristic  is  to  begin  with  a  reasonably  good  initial  solution.  In  the  [Sech86]  algorithm,  the 
non-annealing  first  stage  selects  a  large  number  of  good  starting  solutions.  This  effectively  provides  the 
second  stage  (annealing)  with  a  boost.  Thus,  stage  two  does  not  waste  time  examining  poor  solutions  just  to 
identify  better  ones. 

We  find  that  staging  concepts  are  also  applicable  to  our  annealing-based  algorithm  for  the 
WRP.  Our  current  implementation  finds  one  good  initial  starting  solution  from  which  to  begin  annealing. 
However,  several  initial  starting  solutions  could  improve  the  performance  of  die  overall  algorithm.  Chapter 
III  discusses  how  an  initial  solution  is  found.  In  Chapter  IV,  we  suggest  how  to  obtain  multiple  starting 
solutions  might  be  obtained.  Chapter  IV  also  describes  heurisdcs  for  preconditioning  weighted  region  maps 
to  improve  path  annealing  performance. 

c.      Robot  Arm  Movement 

The  problem  of  efficiendy  and  safely  moving  the  end  effector  of  a  robot  arm  through  three- 
dimensional  space  is  another  path-planning  problem  to  which  simulated  annealing  has  been  applied.  The 
algorithm  of  [Lind87]  uses  an  octree  representation  of  space  in  which  to  plan  movement  for  a  manipulator  of 
5  or  6  degrees.  Simple  problem  instances  are  handled  by  a  deterministic  algorithm.  However,  simulated 
annealing  tackles  the  complex  cases.  Here  again,  we  see  a  two-stage  approach.  However,  in  contrast  to 
previously  discussed  applications,  it  is  the  first  stage  of  this  algorithm  that  uses  annealing,  not  the  second.  The 
first  stage  finds  solutions  for  movement  of  the  first  three  links  closest  to  the  manipulator  base,  corresponding 
to  coarse  movement.  The  solutions  are  near-optimal  in  the  sense  that  they  minimize  the  link  movements 
(torque  and  translation)  required  to  translate  the  last  three  links  to  the  target  position  in  space.  The  second 
stage  deterministically  locates  refined  soludons  for  the  links  closest  to  the  wrisL 
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Another  example  of  an  annealing-based  algorithm  for  manipulator  arm  movement  planning 
is  found  in  [Carr90].  This  work  reports  that  reasonably  good  solutions  are  obtained  from  relatively  simple 
annealing  schedules.  We  have  also  found  such  to  be  the  case  in  our  approach  to  the  WRP.  Although  we 
performed  some  very  limited  testing  with  more  elaborate  annealing  schedules,  the  best  results  came  from  the 
simplest  ones. 
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III.  PATH  ANNEALING  DESIGN 

A.  INTRODUCTION 

Path  annealing  is  a  probabilistic  algorithm  which  combines  a  fast,  crude  systematic  search  with  a  non- 
exhaustive  local  search  to  find  near-optimal  solutions  for  the  weighted-region  problem.  This  chapter  presents 
the  basic  design  concepts  for  the  path  annealing  algorithm. 

In  this  chapter  we  introduce  and  define  many  terms  and  concepts  specific  to  path  annealing.  Some  of 
these  concepts  refer  to  supporting  theorems  which  are  presented  only  informally  (with  intuitive  explanations 
as  required  for  immediate  understanding).  A  more  formal  statement  of  the  theorems  and  associated  proofs  is 
contained  in  Appendix  A. 

Since  we  desired  to  implement  a  prototype  of  path  annealing  quickly,  we  chose  to  use  Quintus  Prolog 
Release  2.5  [Quin90]  as  our  base  language.  There  were  many  good  reasons  for  this  decision.  Prolog  code  for 
several  standard  algorithms  used  in  our  work  (such  as  A*  search)  was  available  through  other  related  research 
projects.  Generic  Prolog  is  very  high-level  and  provides  automatic  backtracking.  Furthermore,  Quintus 
Prolog  provides  automatic  hashing,  compilation,  a  foreign  language  interface,  and  graphic  display 
capabilities.  All  of  these  facilities  were  used  to  develop,  debug,  and  optimize  the  prototype.  Appendix  B  is  a 
complete  listing  of  all  source  code. 

B.  STATE  SPACE  REPRESENTATION 

1.      Window  Sequences 

For  a  WRP  instance  define  the  solution  space  as  the  collection  of  all  conceivable  piecewise  linear 
paths  between  start  and  goal,  whose  turning  points  (between  linear  segments)  occur  at  regional  boundary 
edges  or  vertices.  We  omit  from  this  collection  all  paths  with  turning  points  which  do  not  lie  on  regional 
boundaries  because  such  paths  can  never  be  optimal.  Furthermore,  it  is  always  possible  to  improve  the  cost 
of  such  a  path  by  shortcutung  any  turning  points  which  occur  in  region  interiors.  Note  that  we  do  not  exclude 
cyclic  paths,  even  though  such  paths  cannot  be  optimal.  WRP  solution  space  contains  an  uncountably  infinite 
number  of  solutions.  The  convexity  theorem  does  not  apply  to  the  solution  space  as  a  whole  unless  all  paths 
between  start  and  goal  must  cross  the  same  sequence  of  edges  in  exactly  the  same  order  (a  possible,  but  very 
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unlikely  problem  Instance).  Mosl  problem  instances  contain  many  palh-COSt  discontinuities.  In  order  to 
manage  such  complexity  we  desire  to  represent  this  space  in  some  discrete  form. 

Recall  from  Section  II.A.l.c  that  die  primary  reasons  for  representing  the  WRP  search  space 
discretely  are:  ( I )  to  utilize  the  cost  function  convexity  theorem  for  paths  which  cross  the  same  sequences  of 
consecutive  boundary  edges;  and  (2)  to  make  the  problem  suitable  for  combinatorial  optimization.  We  assign 
a  unique  integer  identifier  to  each  region  boundary  edge.  Furthermore,  we  assign  identifiers  s  and  g  to 
designated  start  and  goal  points  respectively.  We  now  define  the  concept  of  window  sequence  (WS).  This 
concept  was  originally  adopted  by  |Ross89)  to  describe  a  family  of  paths  which  cross  the  same  sequence  of 
boundary  edges  and  vertices  and  which  must  obey  the  same  set  of  movement  constraints.  Our  definition  of 
window  sequence  is  similar,  but  not  identical.  Consider  the  continuous,  infinite  set  of  all  paths  between  the 
start  and  gad  points  which  cross  the  same  ordered  sequence  of  edges.  We  can  uniquely  label  this  family  of 
paths  using  an  ordered  list  of  edge  identifiers.  The  first  and  last  elements  of  Uiis  list  arc  always  s  and  g 
Corresponding  to  start  and  goal  respectively.  Such  an  ordered  set  is  called  a  window  sequence.  Figure  3.1  is 
an  example  of  a  window  sequence  (WS).  Duplicate  edge  identifiers  arc  permitted  within  a  legitimate  WS. 
lliis  simply  means  that  a  family  of  paths  must  cross  die  same  edge  multiple  limes.  Also,  note  that  a  WS  must 
include  every  edge  identifier  that  its  associated  paths  cross.  Identifiers  may  not  be  skipped  in  a  valid  WS  list. 


Figure  3.1      Window  Sequence 


34 


Note  that  a  WS  is  not  the  same  as  a  wedge  [Rich87|  as  in  Figure  2. 1 .  A  wedge  has  a  start  but  no 
terminating  point,  and  consisLs  of  only  Snell's  Law  paths  defined  between  extreme  left  and  right  bounding 
paths.  In  contrast,  a  WS  has  both  start  and  terminating  points  and  consists  of  all  paths  (regardless  of  Snell's 
Law)  which  cross  the  given  sequence  of  defining  edges.  Nevertheless,  the  convexity  theorem  of  [Rowc90b] 
and  [Mitc90]  still  applies  to  WS  because  the  theorem  places  no  restriction  on  edge  length  and  the  path-cost 
function  remains  the  same.  Therefore,  a  unique  locally  optimal  path  must  exist  within  each  WS,  and  a 
standard  continuous  function  optimization  method  can  be  used  to  locate  it. 

Window  sequences  partition  the  WRP  solution  space  into  possibly  overlapping  classes  of  paths. 
We  can  identify  a  number  of  desirable  properties  which  emphasize  the  advantages  of  a  window  sequence 
representation: 

•  All  WS's  are  discretely  represented  by  ordered  lists  of  edge  identifier 

•  Assuming  a  bordered  map,  the  total  number  of  WS's  is  finite. 

•  Every  path  in  the  WRP  solution  space  is  contained  in  some  WS. 

•  Some  WS  contains  the  globally  optimal  path. 

•  Consecutive  turning  points  between  path  segments  are  always  visible. 

Though  finite,  the  number  of  states  (i.e.  window  sequences)  in  this  space  is  very  large.  However,  if  we  can 
find  the  locally  optimal  path  of  any  WS,  then  we  have  a  means  of  comparing  WS's.  By  searching  the 
solution  space  of  WS's  we  can  use  these  costs  to  determine  optimal  or  near-optimal  paths. 

Recall  from  Section  I.B  that  we  assume  all  regions  in  a  WRP  map  are  convex  (with  the  exception 
of  the  non-traversable  border  regionj.  The  reason  is  that  a  convex-region  map  subsumes  the  definition  of  edge 
visibility.  Consecutive  edges  in  a  WS  are  always  completely  visible  to  one  another,  and  so,  visibility 
computations  are  unnecessary.  This  improves  the  efficiency  of  determining  the  locally  optimal  path  in  a  WS. 

2.      Primitive  Data  Structures  and  Operations 

In  order  to  form  a  high-level  representation  of  the  solution  space  v/c  prcprocess  a  WRP  map  into 
several  primitive  data  structures  designed  to  facilitate  rapid  navigation  through  the  space  at  lower  levels.  Our 
input  maps  are  just  a  list  of  boundary  edges  with  defining  vertices  and  associated  cost  coefficients  to  either 
side.  It  is  assumed  that  this  list  represents  a  complete  set  of  straight-line  segments  in  a  planar  graph. 
Henceforth,  we  refer  to  this  graph  as  a  weighted-region  map.  The  input  description  of  each  edge  in  the  map 
conforms  to  a  standard  convention.  Boundary  edge,  E,  is  defined  by  the  set  f  v  v  p.  p.  J,  where  v  and  v 
are  the  coordinates  of  its  terminating  vertices,  and  p  and  p  are  the  cost  coefficients  of  the  regions  it  bounds. 
An  agent  traveling  along  this  edge  from  v  to  v  will  always  see  p  on  his  left  and  p  on  his  right,  when  p  < 


35 


\i  .  However,  if  \i  =  |i  ,  then  the  x  coordinates  of  the  vertices  are  related  as  v  (x)  <  v Ax).  If  (I  =  \i  and  v  Ax) 
=  v2(jc),  then  vy(y)  <  v2(y). 

Map  preprocessing  creates  and  assigns  a  unique  integer  identifier  to  each  edge,  and  stores  it 
together  with  defining  vertices,  associated  weights,  linear  equation  form,  midpoint,  length,  bounded  regions, 
and  directional  data.  This  provides  extremely  efficient  access  since  Quintus  Prolog  [Quin90]  hashes 
predicates  on  the  first  atomic  argument,  in  this  case  the  edge  identifier.  Thus,  given  a  WS  of  edge  identifiers, 
its  vertices,  regions,  and  related  data  are  all  immediately  accessible. 

In  addition  to  the  edges  themselves,  there  are  two  special  structures  which  store  knowledge  about 
spatial  relationships  between  edges.  We  create  an  edge  link  for  each  pair  of  edges  which  end  in  the  same 
vertex  and  are  adjacent  around  the  same  common  vertex.  For  each  such  edge-pair,  the  edge  link  records 
appropriate  edge  identifiers,  the  common  vertex,  and  the  cost  coefficient  of  the  common  region  bounded  by 
the  pair.  We  also  create  an  edge  dual-graph  which  is  a  high-level  data  structure  representing  all  WS's. 
Because  it  is  high-level,  we  defer  discussion  of  this  data  structure  to  the  next  section. 

Since  we  desire  quick  access  among  edges,  vertices,  and  regions,  preprocessing  creates  several 
data  structures  which  are  essentially  inverted  files  indexed  on  these  entities.  For  each  vertex  in  the  map,  a 
vertex  edge-list  is  maintained.  This  data  structure  stores  a  clockwise  ordered  list  of  edges  incident  around  each 
vertex.  Two  similar  data  structures  are  constructed  for  regions.  A  region  edge-list  holds  the  associated  cost 
coefficient  and  the  ordered  list  boundary  edges  for  each  convex  region.  A  region  vertex-list  stores  the  ordered 
list  of  vertices  around  each  region.  As  will  be  explained  later,  obstacles  are  treated  as  though  they  were  special 
oversized  vertices.  Similar  to  a  vertex  edge-list,  an  obstacle  edge-list  stores  an  ordered  list  of  the  incident 
edges  around  each  obstacle. 

The  geometric  nature  of  the  WRP  requires  a  large  number  of  floating  point  operations. 
Unfortunately,  Prolog  was  not  designed  for  efficient  number  crunching.  Furthermore,  Quintus  Prolog  Release 
2.5  floating  point  operations  are  accurate  to  only  6  decimal  digits  of  precision.  To  compensate  we 
implemented  many  primitive  routines  in  C,  (see  Appendix  B).  particularly  floating  point  operations.  These 
are  called  as  Prolog  predicates  through  the  foreign  language  interface.  Common  routines  implemented  in  C 
include:  weighted  and  unweighted  distance  computations,  random  number  generation,  linear  interpolation, 
routines  to  implement  a  heap  data  structure,  Golden  Ratio  and  binary  search  routines,  and  annealing  schedule 
control. 

A  few  primitive  geometric  routines  are  implemented  in  Prolog.  However,  we  have  intentionally 
written  these  procedures  to  execute  simple  arithmetic  operations  only,  avoiding  square  roots  and 
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trigonometry  whenever  possible.  We  have  also  compressed  the  mathematics  in  these  routines  to  as  few 
operations  as  possible.  Line  intersections  are  taken  by  solving  simultaneous  linear  equation  forms. 
Perpendicular  projections  are  done  similarly.  For  efficiency  and  accuracy,  special  cases  (e.g.  intersections  of 
parallel  or  coincident  lines)  are  intercepted  by  pattern  matching  of  coordinates  and  line  equation  coefficients. 
Then,  instead  of  permitting  calculations  which  might  result  in  great  loss  of  precision,  we  attempt  to  solve 
them  through  spatial  reasoning  about  local  geometry.  Directional  heading  computations  require  a  single 
arctangent  operation  at  one  stage,  and  otherwise  they  involve  only  arithmetic  operations.  Again,  special  cases 
are  intercepted  and  handled  separately  by  spatial  reasoning. 

C.      INITIAL  SOLUTION 

Annealing  can  begin  from  any  solution  in  the  space.  However,  empirical  evidence  suggests  that 
reasonably  good  initial  solutions  can  often  provide  better  final  results  [Naha86,  John89].  The  obvious 
straight-line  path  from  start  to  goal  is  not  always  feasible  when  obstacle  regions  are  present  While  there  are 
good  algorithms  for  constructing  and  searching  a  visibility  graph,  this  is  more  work  than  is  necessary.  To 
initialize  path  annealing,  we  conduct  a  limited  search  through  a  special  representation  of  the  WRP  input  map. 

1.      Edge  Dual-Graph 

A  connected  graph  embeddable  in  the  Cartesian  plane  without  intersecting  arcs  and  whose  vertices 
are  minimum  degree  two  is  known  as  a  planar  graph.  Restricting  the  arcs  of  a  planar  graph  to  straight  lines 
results  in  aplanar  straight-line  graph  (PSLG)  [Prep87].  Our  WRP  input  maps  are  PSLG's.  We  further  restrict 
these  maps  to  consist  of  convex  regions  only.  For  all  such  structures,  graph  theory  defines  the  notion  of  a  dual 
graph.  Regions  in  the  planar  graph  become  vertices  in  its  dual  graph;  whereas  vertices  in  the  planar  graph 
become  regions  in  its  dual  graph.  In  the  dual  graph  arcs  connect  vertices  corresponding  to  adjacent  regions  in 
the  original  graph.  Thus,  a  one-to-one  correspondence  exists  between  arcs  in  the  planar  graph  and  arcs  in  its 
dual.  While  this  kind  of  dual  graph  is  often  a  valuable  problem  transformation  (e.g.  Min/Max  Cut  Problem), 
it  is  not  that  useful  for  our  purposes.  Instead,  we  construct  a  dual  representation  for  a  WRP  map  that  differs 
from  the  standard  region  dual-graph  described  above. 

We  define  a  dual  representation  of  a  WRP  map  called  the  edge  dual-graph.  The  discussion  which 
follows  refers  to  two  distinct  representations  of  a  problem  instance  -  the  weighted  region  input  map  and  its 
corresponding  edge  dual-graph.  In  order  to  avoid  confusion,  we  will  use  the  terms  vertices,  edges,  regions, 
and  map  to  describe  a  weighted  region  map.  We  will  use  the  terms  nodes,  arcs,  and  graph  to  describe  the  edge 
dual-graph.  The  edge  dual-graph  is  essentially  an  adjacency  list  representing  the  spatial  structure  of  the  map 
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ai  a  relatively  high  level  of  abstraction.  To  create  this  graph,  we  assign  a  node  to  the  midpoint  of  each  map 
edge  which  does  not  bound  an  obstacle  (or  the  border).  Special  nodes  are  assigned  to  the  start  and  goal  points. 
In  each  non-obstacle  region,  we  add  arcs  to  connect  all  nodes  representing  the  edges  which  bound  the  same 
region.  The  fact  that  all  regions  are  convex  guarantees  that  all  such  arcs  cannot  intersect  obstacles  or  other 
regions.  Thus,  each  region  contains  a  clique  consisting  of  all  nodes  representing  its  non-obstacle  boundary 
edges.  The  regions  containing  the  start  and  goal  points  will  have  additional  arcs  connecting  the  start  or  goal 
node  to  the  clique.  Figure  3.2  illustrates  a  simple  WRP  map  with  its  associated  edge  dual-graph. 


INPUT  MAP 


EDGE  DUAL-GRAPH  O O 


Figure  3.2      Weighted-Region  Problem  Map  and  Edge  Dual-Graph 
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2.      Search  Tor  an  Initial  Solution 

We  obtain  the  initial  solution  by  conducting  an  A*  search  of  the  edge  dual-graph.  The  cost 
function  is  the  weighted  Euclidean  distance.  The  estimated  cost  to  the  goal  is  straight-line  distance  to  the  goal 
weighted  by  the  map's  lowest  cost  coefficient,  p.  .  The  is  an  underestimate  to  the  goal,  because  it  is  weighted 
by  the  optimal  cost.  Therefore,  the  search  is  admissible,  and  returns  the  shortest  weighted  midpoint  path,  and 
the  corresponding  WS  in  which  it  resides.  We  refer  to  this  path  as  the  optimal  midpoint  path.  Note  that  we 
should  not  expect  this  midpoint  path  to  be  globally  optimal;  nor  should  we  expect  that  its  corresponding  WS 
necessarily  contains  a  globally  optimal  path.  However,  the  optimal  midpoint  path  does  represent  a  reasonably 
good  initial  solution. 

Simulated  annealing  does  not  require  the  optimal  midpoint  path  from  which  to  begin.  We  could 
begin  with  any  feasible  solution  regardless  of  its  cosl  So,  we  could  overestimate  distance  to  the  goal,  thereby 
inducing  a  greater  depth-first  component  to  the  search  [Pear84].  Such  an  evaluation  function  usually  finds  a 
solution  faster.  The  resulting  midpoint  path  might  be  of  higher  cost,  but  nevertheless,  will  be  feasible  since 
the  edge  dual-graph  does  not  pass  through  infinite  cost  regions.  However,  there  are  two  advantages  to 
initializing  with  admissible  A*  search.  First,  the  resulting  midpoint  path  is  a  reasonably  good  starting 
solution.  It  is  an  indication  of  a  high-speed  avenue  with  a  higher  potential  for  containing  (though  not 
necessarily)  the  optimal  or  a  near-optimal  path.  Much  empirical  research  indicates  that  simulated  annealing 
is  faster  when  provided  with  reasonably  good  initial  solutions  [John89,  Naha86,  Bono84].  Second,  the  total 
cost  of  this  path  provides  an  upper  bound  on  the  cost  of  the  globally  optimal  path.  Since  we  want  the  least 
upper  bound  obtainable,  then  it  is  desirable  to  find  the  best  midpoint  path. 

D.      COST  FUNCTION  EVALUATION 

In  the  main  phase  of  annealing,  each  newly  generated  WS  must  be  evaluated  to  find  the  cost  of  its 
locally  optimal  path.  In  many  annealing  applications  the  cost  of  a  sample  solution  is  easily  evaluated.  But  in 
path  annealing,  cost  function  evaluation  is  difficult  and  may  require  a  relatively  large  amount  of  computing 
time.  Thus,  streamlining  this  procedure  is  a  high  priority. 

Recall  that  the  convexity  proof  implies  each  WS  contains  a  unique  shortest  path  [Rowe90b,  Mitc90].  It 
is  possible  to  find  this  path  (within  some  precision)  using  Snell's-Law  ray-tracing  and  a  standard  iterative 
search  technique  such  as  false  position  [Rich87].  By  assuming  that  each  edge  in  the  WS  is  an  infinite  length 
line,  we  can  treat  a  WS  similar  to  Richbourg's  wedge.  However,  the  left  and  right  boundaries  defining  a 
wedge  are  Snell's  Law  paths  themselves.  In  contrast,  the  left  and  right  boundaries  of  a  WS  are  lines  through 


39 


the  terminating  vertices  of  the  edges  which  define  the  sequence.  As  a  result,  a  WS  may  have  no  Snell's  Law 
paths  within  it  at  all.  We  find  that  locally  optimal  path  for  many  WS's  is  constrained  by,  and  therefore  passes 
through  one  or  more  of  the  vertices  of  the  defining  edges.  An  iterative  ray-tracing  approach  to  WS 
optimization  can  expend  much  computing  time  backtracking  to  false  starts  caused  by  the  ray  failing  to 
intersect  edges  within  the  WS.  In  the  next  section,  we  describe  WS  optimization  techniques  which  take  more 
advantage  of  the  nature  of  WS's. 

1.       Single-Path  Relaxation  (SPR) 

Because  Snell's  Law  determines  the  local  optimality  criteria  for  path  segments  that  cross 
boundary  edges,  it  is  possible  to  find  the  shortest  path  constrained  to  a  WS  without  iteratively  computing  total 
path-cost.  Given  an  arbitrary  WS  from  start  to  goal,  one  can  locate  the  optimal  path  constrained  to  the  defining 
edges  using  the  coordinate  descent  method  proposed  by  [Smit88]  (also  suggested  by  [Mitc90]).  Beginning 
with  a  path  through  the  midpoints  of  the  edges,  consider  any  set  of  throe  consecutive  points  P  P  ,  and  P  . 
Fix  the  outside  pair,  P  and  P,  and  use  Golden  Ratio  search  [Prcss88]  to  adjust  P  to  the  point  on  the  middle 
edge  at  which  the  weighted  distance  of  path  P  -P  -P  is  minimized.  The  point  P  will  be  located  on  the 
middle  edge  such  that  Snell's  Law  is  satisfied  relative  to  P  and  /%.  Applied  to  any  set  of  three  consecutive 
points  along  a  path  through  a  WS,  this  procedure  cannot  increase  total  path-cost  Because  of  this,  we  may 
apply  the  procedure  iteratively  from  start  to  goal.  Beginning  with  the  first  set  of  three  consecutive  points 
which  includes  the  start  point  as  P  adjust  P  to  its  optimal  location,  and  slide  to  the  next  set  of  three  points. 
This  process  continues  to  the  goal  point,  then  reverses  direction  moving  back  to  the  start.  Passes  continue  in 
alternating  directions  until  one  complete  pass  in  cither  direction  is  made  through  all  points,  during  which  no 
point  moves  from  its  previous  position  more  than  some  precision  c,  referred  to  as  relaxation  tolerance.  The 
procedure  converges  on  the  locally  optimal  path  because  total  weighted  path  length  is  a  monotonically 
decreasing  function  of  the  sequence  of  adjustments  [Smit88].  It  is  also  possible  to  pass  through  the  WS 
continuously  in  the  same  direction  (such  as  start  to  goal).  However,  we  have  found  that  moving  in  alternating 
directions  tends  to  cause  faster  convergence. 

Simulated  annealing  cannot  afford  expensive  primitive  operations.  Smith's  coordinate  descent 
method  avoids  the  direct  use  of  Snell's  Law  and  expensive  trigonometric  functions,  which  is  good.  Also,  the 
technique  makes  good  use  of  the  hounding  vertices  of  the  edges.  However,  simple  testing  of  coordinate 
descent  using  Golden  Ratio  search  suggests  that  Smith's  method,  though  accurate,  is  too  slow  to  be  of 
practical  value  in  path  annealing,  since  long  WS's  can  require  a  very  large  number  of  iterations.  Furthermore, 
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wide  window  sequences  with  long  edges  can  have  very  slow  convergence  to  the  locally  optimal  path. 
Therefore,  we  investigated  faster  alternatives. 

Direct  determination  of  a  starting  direction  for  a  ray-trace  which  must  cross  several  boundary 
edges  to  hit  a  known  target  point  is  very  difficult.  Combining  the  system  of  equations  representing  the  Snell's 
Law  criterion  at  each  boundary  crossing,  results  in  a  very  high-degree-polynomial  equation,  whose  solution 
yields  the  starting  and  target-point  coordinates  [Mitc90].  However,  if  only  a  single  boundary  edge  separates 
the  starting  point  and  the  target,  then  we  only  need  to  determine  the  point  of  optimal  crossing  on  the  boundary 
edge  between  start  and  target.  Snell's  Law  has  no  closed  form  to  compute  this  point  directly.  This  is  one 
reason  that  [Smit88]  resorts  to  Golden  Ratio  search.  Nonetheless,  if  the  range  of  region  cost  coefficient  values 
is  known,  then  we  can  direcUy  determine  optimal  crossing  points  with  a  very  fast  table-lookup  procedure.  We 
employ  this  procedure  in  the  coordinate  descent  technique  described  earlier  by  replacing  Golden  Ratio  search 
with  a  constant-time  Snell's-Law-table  lookup.  We  refer  to  our  method  of  coordinate  descent  using  table- 
lookup  as  single-path  relaxation  (SPR). 

The  problem  of  finding  a  Snell's  Law  crossing  point  on  a  boundary  edge  between  two  fixed  points 
requires  a  three-dimensional  table.  Recall  from  Chapter  I  that  by  rescaling  rational  cost  coefficients  [Mitc90], 
it  is  always  possible  to  establish  integer  cost  coefficients  for  a  WRP.  To  construct  an  appropriate  Snell's-Law 
lookup  table,  it  is  necessary  to  determine  the  expected  working  range  of  cost  coefficient  ratios  a  priori.  By 
working  range,  we  mean  those  encountered  most  often  in  maps  of  interest.  Our  implemented  table  uses 
integer  ratios.  It  is  not  necessary  for  the  set  to  include  every  ratio  to  be  encountered;  out-of-bounds  conditions 
can  always  trigger  a  more  expensive  Golden  Ratio  search.  However,  our  objective  is  to  severely  reduce  the 
number  of  times  a  lookup  must  resort  to  iterative  search. 

Given  fixed  approach  points  P  and  P  ,  we  normalize  the  geometry  of  a  typical  crossing  episode 
on  a  standard  rectangle  as  shown  in  Figure  3.3.  Note  that  we  orient  this  rectangle  such  that  the  crossing  edge 
is  always  parallel  to  the  x  axis.  Four  parameters  characterize  every  crossing  episode  geometrically  similar  to 
this  rectangle: 

p  =  \ij\x.        (ratio  of  cost  coefficients)  (Eq  3.1) 

r  =  x/y        (inverse  of  the  slope  of  line  PjP2)  (Eq  3.2) 

y'=  yly        (ratio  of  y  coordinates  of  P  and  P  )  (Eq  3.3) 

yf=  xJy        (ratio  of  x  coordinate  of  P   to  y  coordinate  of  P  )  (Eq  3.4) 
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Figure  3.3     Crossing  Episode  Geometry 


The  mathematical  basis  of  the  table  is  derived  as  follows.  For  optimal  crossing  point  P    Figure  3.3  obeys 
Snell's  Law: 

Sin(07)  /  Sin(92)  =  ^  /  u,  =  p  (Eq  3.5) 

Letting  p  =  \i-J\i.  and  applying  trigonometric  identities  we  derive  the  equivalent  expression: 

p  =  Cos(ArcTan(y0/x0))  /  Cos(ArcTan((yr>0)/(x  -xj))  (Eq  3.6) 

Multiplying  each  arctangent  argument  by  (l/v)/(l/v)  and  substituting  yields  a  parametric  equation  in  four 
variables,  where  p,  r,  and  /  determine  xf: 

p  =  Cos(ArcTan(y7;0)  /  Cos(ArcTan((l->0/(''-x')))  (Eq  3.7) 

where  x'  =  xjy{,  p  =  p./p-2,  r  =  x/yf  and  y'=  yjyf 
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For  any  given  crossing  episode,  the  values  of  p,  r,  and  y'  are  known.  Golden  Ratio  search  precomputes  the 
table  values  of  x  which  satisfy  Eq  3.7  for  discrete  values  of  the  other  parameters.  Figure  3.4  tabulates  the 
parameter  ranges  and  key  characteristics  of  our  prototype  Snell's-Law  lookup  table. 


Range 

Low        High          Increment          No. 

of  Values 

p            1.00        10.00                  * 
r             0.00        10.00                 0.05 
y'           0.00          1.00                 0.05 

45 

201 

21 

*  based  on  cost  coefficient  ratios  ja2/Mi  =  P 
where  \i\  e  {1,2,3,...,10}  and  n1  <  fi2 

Total  no.  of  function  points  =  45  *  201  *  21  = 

189945 

Total  raw  space  required  on  disk  =  760180  bytes 

Figure  3.4      Characteristics  of  Snell's-Law  Lookup  Table 

Recall  that  all  region  weights,  p..,  are  drawn  from  the  integer  set  { 1,2,.. ,10,°°}.  We  use  this  set  to 
indirecUy  index  the  proper  value  of  p  in  the  lookup  table.  Note  that  it  is  always  possible  to  orient  the  geometry 
of  an  episode  such  that  p  <  1  is  true.  Therefore,  we  employ  a  two-dimensional  triangular  array  of  45  entries, 
indexed  by  integer  p.  values  in  numerator-denominator  pairs.  The  array  holds  the  indices  to  the  exact  values 
of  x  in  the  lookup  table. 

Consider  the  generalized  crossing  episode  in  Figure  3.3.  From  fixed  points  P  and  P  we  can 
easily  determine  intersections  I  ,  I  ,  and  I  ,  and  associated  distances  relative  to  the  edge,  E  .  With  this  data 
the  lookup  procedure  computes  the  parameters  r  and  y.  The  parameter,  p,  is  exact  and  indexes  the  appropriate 
plane  in  the  table.  Using  r  and  y\  the  indices  are  created  to  bracket  the  appropriate  value  for  x  within  a  two- 
dimensional  rectangle.  Simple  linear  interpolation  determines  a  value  for*'.  This  value  gives  the  location  of 
the  optimal  crossing  site  on  E  relative  to  both  y ,  and  its  left  vertex.  Since  x  =  xJy ,  then  the  location  of  the 
optimal  point  relative  to  x  is  x  =  xfy . 
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The  location  of  the  optimal  crossing  point  on  E  assumes  an  infinitely  extended  boundary  edge. 
However,  all  boundary  edges  are  actually  finite  length  segments.  Therefore,  the  opumal  crossing  point  may 
not  always  lie  between  the  vertices  which  define  the  boundary  edge.  In  such  cases,  the  optimal  crossing  point 
will  be  the  closest  vertex.  We  refer  to  these  occurrences  as  constrained  crossings,  because  the  optimal 
crossing  must  violate  Snell's  Law  (as  little  as  possible)  to  satisfy  restrictions  of  boundary  edge  length.  A 
constrained  crossing  is  illustrated  in  Figure  3.5. 


constraining 

i  vertices              ^y 

i| 

i 

-          ^2 

\ 

jZ>* 

^^ T 

F 

>    ^^^^^^ 

unconstrained  best  path 

Figure  3.5     Constrained  Optimal  Crossing 

By  always  orienting  the  crossing  edge  E  fixed  points  P  and  P  and  cost  coefficients  \i  and  \i 
as  shown  in  Figure  3.3,  we  can  detect  many  constrained  crossings  before  applying  the  complete  table-lookup 
procedure.  Note  that  in  Figure  3.3  an  unconstrained  optimal  crossing  can  only  occur  between  intersection 
points  /  and  /  .  If  both  vertices  of  the  crossing  edge  lie  outside  of  the  interval  defined  by  /  and  /  ,  then  a 
constrained  crossing  is  certain,  and  table-lookup  is  unnecessary.  The  vertex  closest  to  the/  -/  interval  is  the 
opumal  crossing  site.  Otherwise,  if  a  table-lookup  is  still  necessary,  the  location  of  the  optimal  crossing  point 
returned  by  the  lookup  is  compared  to  the  location  of  edge  vertices  to  determine  if  a  constrained  crossing  is 
optimal. 

In  summary,  the  work  to  lookup  x!  requires  three  intersections,  three  distance  calculations  (to 
determine  x,  y ,  yX  and  one  linear  interpolation  in  two  dimensions.  Thus,  a  single  lookup  can  be  done  in 
constant  time.  On  rare  occasions,  if  the  geometry  of  a  crossing  episode  causes  the  parameters  to  fall  outside 
the  bounds  of  the  table,  then  the  lookup  procedure  defaults  to  Golden  Ratio  search.  The  major  steps  of  the 
optimal-crossing-point  lookup  algorithm  are  outlined  in  Figure  3.6. 
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Input: 

fixed  points  P-,,  P2 

crossing  edge  Eq  (defined  by  vertices  V-,,  V2) 

cost  coefficients  |i1s  u2  where  ji-j  <  u.2 
Output: 

Snell's  Law  crossing  point  P0 

Optimal  Crossing  Point  Algorithm: 

Assume  that  Eq  extends  infinitely  in  both  directions  and  compute 
straight-line  intersection  l0  of  E0  and  line  P1P2- 

IF  E0  is  a  phantom  edge 

THEN  l0  is  Pq,  check  for  constraining  vertices  and  return 
ELSE  compute  perpendicular  intersection  l2  from  P2  on  E0 
IF  V2  is  between  l2  and  V^ 

THEN  V2  is  P0. 
ELSE  IF  V1  is  between  V2  and  l0 

THEN  V^  is  P0,  return  V^  as  P0 
ELSE  compute  perpendicular  intersection  11  from  P1  to  Eq 

CALL  C  routine  snell(P1,P2,l1,l0i|2.^2»Mi)-  Sne"  uses  U^h  to 
determine  if  table  lookup  can  compute  P0.  If  not,  then  l0,l2  are 
used  as  starting  points  for  Golden  Ratio  search  to  find  P0. 

Check  for  constrained  Snell's-Law  vertex  crossing  and  return. 


Figure  3.6     Optimal-Crossing-Point  Table-Lookup  Algorithm 

To  compare  the  table  lookup  procedure  to  pure  Golden  Ratio  search,  we  generated  random 
crossing  episodes  across  a  single  boundary  edge  of  100  map  units  in  length.  For  each  episode  one  random 
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point  was  selected  from  each  square  region  on  either  side  of  the  crossing  edge.  For  the  two  regions,  unequal 
pairs  of  weights,  \i  and  \i  ,  were  randomly  assigned  from  the  set  {1,2,...,10}.  Timing  results  of  the  tests 
indicate  that  the  table  lookup  is  one  order  of  magnitude  (10  times)  faster  than  pure  Golden  Ratio  search.  These 
results  include  time  needed  by  the  table  lookup  procedure  to  perform  an  occasional  Golden  Ratio  search  when 
random  out-of-bounds  conditions  occur.  To  compute  the  accuracy  of  the  lookup  routine,  we  assume  that 
Golden  Ratio  search  finds  the  exact  optimal  point  and,  consequently,  the  true  minimum  weighted  distance. 
Let  CnD  be  the  total  weighted  cost  of  a  crossing  episode  as  computed  by  Golden  Ratio  search.  Let  the 

Cm 

corresponding  table-lookup  value  be  C_ .  We  compute  relative  error  in  weighted  distance  as 

lCTL-CGRl/CGR  ^3-8> 

7  fk 

For  100,000  random  samples  the  mean  relative  error  was  3.83x10"  with  standard  deviation  1.73x10'  .  The 
maximum  relative  error  is  on  the  order  of  10  ,  and  occurs  in  less  than  0.01%  of  the  sample.  We  should 
expect  some  error,  since  our  two-dimensional  linear  interpolation  is  an  approximation  of  a  curved  surface  by 
a  flat  plane.  Figure  3.7  is  a  plot  of  the  discrete  points  in  the  table  for  p  =  1.1.  Although  slight,  the  curvature 
of  this  surface  is  most  noticeable  at  the  lower  values  of  r  and  y'.  The  squaring  and  square  root  operations  of 
weighted  distance  soften  the  effect  of  interpolation  error  on  x '.  Nonetheless,  we  can  rely  on  about  5  decimal 
digits  of  accuracy  for  the  optimal  weighted  distance  of  a  crossing  episode.  Note  that  there  are  only  6  decimal 
digits  of  precision  provided  by  our  implementation  language,  Quintus  Prolog  [Quin90].  Depending  upon  the 
length  of  a  WS  (i.e.  how  many  crossing  episodes),  errors  can  accumulate.  However,  because  mean  relative 
error  is  essentially  zero,  we  may  assume  that  errors  accumulated  over  long  WS's  will  usually  cancel  one 
another.  We  conclude  that  the  Snell's-Law-table  lookup  method  provides  SPR  with  a  reasonably  accurate 
and  efficient  means  for  computing  optimal  crossing  points  on  boundary  edges. 
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Figure  3.7     Surface  Plot  of  SnelPs-Law  Table  (*'  =/(y»  for  p=l.l) 

2.      Uniform-Discrete-Point  (UDP)  Approximation 

While  local  path  optimization  with  SPR  is  fast,  the  procedure  can  sometimes  run  into  worst  case 
situations.  In  practice  we  have  found  that  even  with  a  relatively  slack  relaxation  tolerance,  SPR  may 
sometimes  converge  at  an  unacceptably  slow  rate.  This  happens  if  the  midpoint  path  (starting  condition)  is 
far  from  optimal  and  has  few  sharp  bends.  In  such  situations  the  improvement  of  each  crossing-point 
adjustment  may  be  slight.  Therefore,  a  large  number  of  iterations  may  be  necessary  to  optimize  the  path. 
Figure  3.8  illustrates  a  typical  worst  case  for  SPR.  In  this  example  the  rate  of  SPR  convergence  decreases 
rapidly  as  the  solution  approaches  optimum. 
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where  8  «  1                        n^  q 

Figure  3.8   Worst  Case  Convergence  for  Single-Path  Relaxation  (SPR) 
(dark  path  marks  progress  from  midpoints  after  four  passes) 


Usually  at  high  annealing  temperatures  a  large  number  of  the  WS's  sampled  will  have  locally 
optimal  path-costs  which  are  very  large.  Therefore,  accurate  WS  cost  evaluation  is  only  necessary  when  the 
locally  optimal  path  might  be  globally  optimal.  Both  theoretical  and  empirical  evidence  validate  the  use  of 
approximations  to  the  actual  cost  function  [Adam85,  Tove88].  To  capitalize  on  this  idea,  we  implement  a  very 
simple  approximation  to  pre -evaluate  the  cost  function  of  a  WS.  We  refer  to  the  method  as  uniform-discrete- 
point  (UDP)  search.  It  is  essentially  Dijkstra's  algorithm  restricted  to  a  WS.  UDP  is  used  to  rapidly 
approximate  the  locally  optimal  path  through  a  WS,  and,  if  necessary,  to  provide  a  starting  path  for  SPR. 
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Uniformly  spaced  points,  called  edge-points,  are  specified  on  each  edge  in  the  WS.  From  the  start  point,  all 
paths  constrained  to  pass  through  this  set  of  points  are  searched.  The  discrete  interval,  8,  defines  the  upper 
bound  for  the  separation  distance  of  any  pair  of  adjacent  edge-points.  Given  a  value  for  8,  all  edge-points  can 
be  predetermined  and  stored  for  all  boundary  edges.  For  a  given  edge  of  length,  /,  the  number  of  required 
edge-points  is 

m  =  r(//8)+ll.  (Eq3.9) 

The  m  points  (which  include  terminating  vertices)  are  then  evenly  spaced  across  the  edge.  For  any  edge  with 
non-zero  length,  there  must  be  a  minimum  of  two  edge-points  -  the  terminating  vertices.  Note  that  the 
resulting  structure  can  be  viewed  as  a  higher  resolution  edge  dual-graph. 

This  idea  is  similar  to  one  used  by  [Papa85]  to  efficiently  approximate  the  optimal  path  through  a 
field  of  polyhedral  obstacles.  To  each  obstacle  edge,  he  assigns  discrete  points  spaced  exponentially  out  in 
either  direction  from  the  closest  point  on  the  edge  (the  perpendicular  intersection  from  a  previous  fixed 
reference  point).  Exponential  spacing  is  essentially  a  device  which  holds  the  subsequent  path  search  to 
polynomial  time.  However,  the  polyhedrons  in  this  three-dimensional  obstacle-avoidance  problem  are  all 
obstacles  (i.e.  travel  is  not  permitted  within  them).  Therefore,  optimal  paths  tend  to  avoid  their  vertices,  and 
settle  into  closest  approach  tangents  across  polyhedron  edges.  So,  in  a  sense,  exponential  spacing  also 
represents  point  samples  from  a  normal  probability  distribution  centered  at  locations  most  likely  to  be  on  the 
optimal  path.  In  the  WRP  this  notion  is  countered  by  the  added  dependence  of  optimal  paths  upon  relative 
region  weights  as  well  as  direction.  The  relative  positions  and  weights  of  regions  can  often  override  the 
natural  tendency  for  very  straight  optimal  paths.  Therefore,  it  appears  that  uniform  point-spacing  is  more 
appropriate  for  the  WRP. 

To  approximate  the  optimal  cost  of  a  window  sequence  (WS),  the  uniform-discrete-point  (UDP) 
procedure  works  as  follows.  Beginning  from  the  start  point  (or  inversely  the  goal),  Dijkstra's  Algorithm 
proceeds  through  the  WS  toward  the  goal.  Back  pointers  are  recorded  at  each  point  on  an  edge  to  indicate  the 
direction  of  the  shortest  path  back  to  the  start.  When  the  goal  point  is  reached,  the  shortest  path  is  retrieved 
through  back  pointers.  This  search  is  fast  because  it  is  restricted  to  a  WS.  Consequently,  the  search  always 
proceeds  in  order  of  WS  edges  from  the  start  point  The  lime  complexity  of  the  algorithm  is  0(nm  ),  where 
n  is  the  maximum  number  of  edges  in  any  WS  and  m  is  the  maximum  number  of  edge-points  assigned  to  any 
edge  in  the  map.  Note  that  m  is  a  function  of  8  and  the  longest  edge  in  the  map. 
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3.  Combining  Techniques 

In  our  implementation,  to  find  the  locally  optimal  path  in  a  WS,  we  employ  uniform-discrete-point 
(UDP)  approximation  and  single-path  relaxation  (SPR)  in  a  two-stage  combination.  For  a  given  WS,  the  UDP 
solution  path  is  a  more  refined  estimate  of  the  local  optimum  than  die  midpoint  path.  Thus,  UDP  can  hasten 
SPR  convergence  by  finding  a  starting  path  which  is  usually  closer  to  the  true  local  optimum  than  the 
midpoint  path.  In  stage  one,  UDP  rapidly  selects  the  locally  shortest  path  constrained  to  discrete  5-spaced 
edge-points  in  the  WS.  In  stage  two,  SPR  begins  from  the  path  returned  by  UDP  through  these  edge-points. 
Only  a  few  passes  by  SPR  will  suffice  for  convergence  to  the  true  local  optimum. 

Both  UDP  search  and  SPR  can  be  tuned  to  a  desired  accuracy  by  adjusting  the  discrete  interval, 
6,  and  the  relaxation  tolerance,  e  (see  Section  m.D.l),  respectively.  We  have  found  that  setting  8  equal  to  the 
average  length  over  all  edges  tends  to  balance  the  assignment  of  edge-points  uniformly  across  the  map.  We 
assume  that  the  length  of  the  shortest  edge  is  closely  related  to  the  intended  map  resolution  and  required 
solution  accuracy.  Using  mean  edge-length  to  set  8  strikes  a  compromise  between  accuracy  and  speed  over 
all  problem  instances  associated  with  a  given  map.  The  value  of  8  might  also  be  computed  dynamically  based 
upon  the  lengths  of  boundary  edges  between  and  in  the  vicinity  of  start  and  goal  locations.  As  we  will  discuss 
in  Chapter  I\  ,  our  particular  choice  of  8  provides  another  opportunity  to  improve  performance  through 
heuristics. 

4.  Reentrant  Window  Sequences 

A  window  sequence  (WS)  which  contains  at  least  one  reentrant  path  is  called  a  reentrant  window 
sequence.  Recall  from  Chapter  II  that  a  reentrant  path  exits  a  high-cost  region  by  striking  a  boundary  edge  at 
the  Snell's-Law  critical  angle,  travels  along  the  edge  incurring  the  cost  of  the  low-cost  region,  and  reenters 
the  high-cost  region  at  the  critical  angle  (see  Figure  2.3).  Reentrant  WS's  present  no  special  problem  for  UDP 
approximation,  since  this  method  is  not  Snell's-Law  based.  However,  we  note  that  such  WS's  are  distincdy 
different  from  those  which  cannot  contain  reentrant  paths.  A  WS  which  contains  reentrant  paths  should  list 
each  reflective  edge  twice  in  succession  to  indicate  that  there  are  two  distinct  turning  points  on  it  -  the  point 
of  exit  from  and  the  point  of  reentry  into  the  highest  region  it  bounds.  UDP  approximation  simply  assumes 
that  for  each  edge  identifier  in  the  WS  there  must  be  a  corresponding  optimal  path  turning  point.  Given  a  WS 
and  its  edge-points,  the  algorithm  determines  an  optimal  edge-point  on  each  edge  by  running  Dijkstra's 
algorithm.  For  each  edge  listed  twice  in  succession,  weighted  distances  between  all  pairings  of  its  edge-points 
are  computed  using  the  optimal  weight  of  this  edge.  The  pair  returned  as  optimal  on  this  edge  is  the  pair  along 


50 


the  shortest  weighted  back-pointer  path  retrieved  after  the  goal  point  is  reached.  If  a  reentrant  path  is,  indeed, 
locally  optimal  within  the  WS,  then  the  pair  returned  with  the  optimal  list  will  usually  be  those  edge-points 
which  least  violate  Snell's  Law.  However,  in  some  cases  a  reentrant  path  cannot  be  locally  optimal  for  the 
WS  (i.e.  when  it  is  always  cheaper  for  a  path  to  travel  directly  through  the  region  instead  of  reflecting).  This 
happens  most  often  when  a  reentrant  WS  is  forced  onto  a  boundary  edge  from  its  low-cost  side.  Figure  3.9 
illustrates  such  a  situation.  A  reentrant  path  against  edge  E  between  approach  points  p  and  p  is  not  an 
advantage  over  the  direct  path  p  to  pr  In  this  case  the  pair  of  entry/exit  points  returned  corresponds  to  a 
single  point.  The  resulting  path  segments  can  always  be  shortcut  at  less  cost.  However,  we  expect  this  because 
a  reentrant  WS  intentionally  forces  the  cost  evaluation  mechanism  to  find  the  best  path  which  hits  the 
reentrant  edge  whether  or  not  this  path  represents  cost  improvement  over  the  original  direct  route. 
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Figure  3.9     Uniform-Discrete-Point  (UDP)  Approximation  Is  Forced  to  Reenter  a 
Low-Cost  Region  from  the  Low-Cost  Side  of  a  Boundary  Edge 
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Unlike  UDP,  SPR  must  recognize  each  reentrant  path  location  within  the  WS  because  it  must 
adjust  entry  and  exit  points  to  the  Snell's-Law  critical  angle,  instead  of  executing  a  table  lookup.  This  angle 
is  measured  from  the  approach  points,  i.e.  the  edge-crossing  episodes  just  prior  to  and  after  the  reflective 
edge.  When  a  reentrant  path  is  encountered  during  a  single-path  relaxation  pass,  critical-angle  reflection 
points  are  determined  using  Snell's  Law  from  the  most  current  approach  points.  The  stopping  condition  for 
SPR,  i.e.  one  complete  pass  through  the  WS  without  any  point  adjustment  greater  than  tolerance  e,  never 
depends  on  reflection  point  adjustments,  only  on  crossing  point  adjustments.  This  is  because  reflection  points 
are  predetermined  by  the  adjustments  of  their  corresponding  approach  points.  Therefore,  it  is  sufficient  to 
monitor  only  the  adjustments  of  crossing  points  (i.e.  non -reflection  points)  in  order  to  detect  convergence  to 
the  locally  optimal  path. 

Recall  from  Chapter  I  thai  phantom  edges  are  edges  which  which  bound  regions  with  equal  cost 
coefficients.  They  are  used  to  ensure  that  all  regions  are  convex.  When  a  reentrant  path  is  forced  against  either 
a  phantom  edge  or  a  higher-cost  edge,  it  is  known  a  priori  that  the  reentering  path  cannot  be  locally  optimal. 
In  such  cases,  SPR  ignores  the  reentrant  path  route  and  optimizes  the  straight-line  path  between  crossing 
episodes  immediately  before  and  after  the  points  of  reflection  (i.e.  approach  points),  effectively  bypassing  the 
reflective  edge  This  situation  is  illustrated  in  Figure  3.10.  The  WS  still  lists  the  reflective  edge  twice.  The 
reason  for  th  is  that  there  may  still  exist  an  edge  within  the  adjacent  region  bounded  by  the  reflective  edge 
on  which  reflection  may  still  be  advantageous.  This  will  be  discussed  more  in  the  next  section. 
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Figure  3.10     Single-Path  Relaxation  (SPR)  Ignores  Non-Advantageous  Reentrant 
Path  When  Forced  to  Reenter  a  Low-Cost  Region 


E.      MOVE  OPERATIONS 

Simulated  annealing  samples  many  different  solutions  by  randomly  applying  move  operators  to  explore 
the  solution  space.  In  path  annealing,  the  move  generator  works  in  the  space  of  WS  's.  Recall  that  we  represent 
each  WS  uniquely  as  an  ordered  list  of  edge  identifiers.  A  new  WS  can  be  created  from  another  by  little  more 
than  random  number  generation,  data  retrieval,  and  list  processing.  The  move  generator  perturbs  the  current 
WS  by  rerouting  it  through  neighboring  edges  and  regions.  Repetition  of  this  process  enables  random  search. 
Annealing  does  not  normally  search  the  entire  solution  space.  Nevertheless,  all  feasible  solutions  should  have 
some  chance  of  being  sampled.  Our  prototype  employs  two  very  simple  move  operators.  These  operators 
require  data  structure  support  in  addition  to  the  edge  dual-graph  (previously  discussed).  In  this  section,  we 
introduce  these  move  operators  and  discuss  their  sampling  capabilities. 
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1.  Vertex  Rotation 

Consider  an  arbitrary  window  sequence,  WS  ,  between  designated  start  and  goal.  One  of  the 
simplest  ways  to  obtain  a  new  window  sequence,  WS  ,  is  to  shift  WS  across  a  vertex  which  defines  one  of 
its  edges.  We  call  this  operation  vertex  rotation.  The  operation  is  relatively  efficient  because  vertex  edge-lists 
(see  Section  III.B.2)  are  readily  available  in  sorted  order. 

Given  WS  ,  path  annealing  generates  a  neighboring  WS  as  follows.  Generate  a  random  integer  to 
select  one  vertex  of  one  edge  in  WS  .  This  vertex,  called  the  rotation  vertex,  defines  the  site  of  intended 
displacement.  If  the  rotation  vertex  is  a  border  vertex  then  backtrack  and  randomly  select  another  vertex.  Let 
£  be  the  vertex  edge-list  for  the  rotation  vertex.  Let  £'  be  those  edges  in  E  which  are  also  members  of  WS  . 
Then,  WS  is  defined  by  the  set  operations 

WS2  =  (WS  -  £0  u  (£  -  £0  =  (WS  -  £0  u  E'  (Eq  3.10) 

Eq  3.10  simply  implies  that  we  replace  the  edges  in  £  currently  in  WS  with  the  edges  in  £  which  are  not  in 
WS  .  The  result  is  WS  .  Of  course,  order  in  each  set  is  significant,  and  list  reversals  must  be  performed  as 
necessary. 

The  vertex  rotation  operator  has  an  important  side-effect.  Given  the  rotation  vertex  V  ,  the  current 
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WS  is  scannee  for  the  first  and  last  occurrences  of  edges  in  the  vertex  edge-list  of  V  .  All  edges  between  these 
two  edges  in  lusive  will  be  removed.  Thus,  if  random  perturbations  have  formed  a  WS  with  an  open  loop 
which  crosses  two  edges  incident  to  VD,  then  a  rotation  across  V  will  cause  the  WS  to  cross  itself  at  the  open 
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base  of  this  loop,  and  the  set  operations  of  Eq  3.10  will  remove  it.  By  the  Optimality  Principle,  a  globally 
optimal  path  cannot  cross  itself.  It  follows  that  any  WS  which  crosses  itself  cannot  contain  the  optimal  path. 
Therefore,  a  significant  advantage  of  vertex  rotation  is  its  automatic  removal  of  WS's  which  contain  cyclic 
paths. 

2.  Obstacle  Jumping 

The  presence  of  obstacles  necessitates  special  consideration.  Recall  that  the  edge  dual-graph 
which  represents  the  feasible  solution  space  does  not  contain  arcs  through  obstacle  regions.  However,  we  can 
view  obstacles  as  enlarged  vertices  with  non-zero  area.  Thus,  to  enable  obstacle  rotation  or  obstacle  jumping, 
we  employ  a  special  data  structure  similar  to  a  vertex  edge-list.  An  obstacle  edge-list  (see  Section  m.B.2) 
records  the  clockwise  ordered  list  of  incident  edges  around  an  obstacle.  If  an  obstacle  vertex  is  selected  as  the 
displacement  site,  the  WS  shifts  completely  across  the  obstacle  by  using  the  operation  of  Eq  3.6,  where  £  is 
now  the  appropriate  obstacle  edge-lisL 
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It  is  also  possible  to  jump  some  obstacles  by  a  sequence  of  normal  interior  vertex  rotations.  A  jump 
of  this  type  occurs  as  the  result  of  pinching  a  looping  path  which  has  circled  the  obstacle  from  both  the 
clockwise  and  counterclockwise  directions.  Figure  3.1 1  illustrates  a  path  within  a  WS  with  the  potential  for 
jumping  obstacle  region  A.  Closing  the  base  of  the  loop  by  rotating  across  vertex  V  will  remove  the  detour 
around  obstacle  region  A,  replacing  it  with  the  dotted  path  segment  and  its  associated  WS.  Not  all  obstacles 
can  be  jumped  in  this  manner.  For  such  a  jump  to  occur  enough  interior  vertices  and  edges  must  surround  the 
obstacle  so  that  a  WS  can  be  perturbed  completely  around  it  in  either  direction.  Obviously,  obstacles  which 
connect  directly  to  the  map  border  cannot  be  jumped  this  way  (e.g.  the  obstacle  region  B  in  Figure  3.1 1).  For 
such  cases,  explicit  obstacle  rotation  is  necessary. 


Figure  3.11     A  Path  with  the  Potential  to  Jump  Obstacle  A  on  a  Single  Vertex 

Rotation  at  V„ 
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While  obstacles  and  interior  vertices  are  logically  equivalent  with  respect  to  the  rotation  operator, 
we  ensure  that  they  are  distinguishable.  In  particular  problem  instances  it  may  be  more  efficient  to  reduce  or 
temporarily  prevent  the  capability  to  jump  obstacles.  This  control  is  necessary  because  the  move  generator 
can  have  a  natural  bias  toward  selection  and  jumping  of  large  obstacles  with  many  vertices.  This  is  especially 
true  when  the  current  WS  includes  several  edges  incident  to  the  same  obstacle,  as  is  often  the  case 
immediately  after  jumping  it.  In  such  situations,  given  an  equal  probability  of  selecting  any  edge  in  the  WS 
from  which  to  obtain  the  rotation  vertex,  that  vertex  with  the  most  incident  edges  in  the  WS  will  have  the 
greatest  likelihood  of  being  selected.  This  bias  can  waste  valuable  sampling  time  with  useless  repetition  as 
the  move  generator  attempts  to  jump  back  and  forth  across  a  single  large  obstacle.  As  well,  there  are  good 
reasons  for  ignoring  this  bias  and  allowing  the  annealing  process  to  make  its  own  decisions.  We  defer  a  more 
complete  discussion  of  these  reasons  and  methods  of  obstacle  control  to  Chapter  IV. 

3.      Reachability 

Recall  that  the  move  operators  should  guarantee  reachability;  that  is,  that  all  feasible  solutions 
which  could  be  optimal  are  accessible  to  the  annealing  process  with  a  non-zero  probability.  This  is  to  ensure 
that  optimal  solution  cannot  be  overlooked  intentionally.  Do  not  confuse  this  term  with  completeness,  which 
describes  a  seemingly  similar  guarantee  offered  by  systematic  search  algorithms.  The  difference  is  in  the 
probability  i  I  locating  a  globally  optimal  solution.  An  algorithm  which  offers  completeness  will  find  the 
optimal  solution  with  probability  one;  the  probability  of  not  finding  it  is  zero.  However,  reachability  means 
that  both  the  probability  of  finding  the  optimal  solution  as  well  as  not  finding  it  are  non-zero. 

A  move  generator  based  only  upon  the  rotation  operators  (vertex  and  obstacle)  can  only  guarantee 
reachability  for  a  subset  of  those  WS's  with  the  potential  to  contain  a  globally  optimal  path.  We  refer  to  this 
subset  as  the  class  of  proper  window  sequences.  The  class  of  proper  window  sequences  is  all  WS's  which  do 
not  enter  the  same  cost  region  more  than  once.  This  definition  implies  that  no  proper  WS  can  cross  any 
boundary  edge  more  than  once,  otherwise  it  necessarily  reenters  some  region.  In  contrast,  an  improper 
window  sequence  may  enter  the  same  cost  region  multiple  times.  We  have  proven  in  Theorem  3.3  (see 
Appendix  A)  that  all  proper  WS 's  are  reachable  from  any  initial  proper  WS  in  a  convex  weighted  region  map. 
Thus,  if  only  proper  WS's  could  contain  globally  optimal  paths  then  our  move  generator  would  guarantee 
reachability.  Unfortunately,  in  some  problem  instances  an  improper  WS  may  contain  the  optimal  path.  The 
next  section  discusses  these  improper  WS's  and  the  additional  move  operator  required  to  reach  them. 
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4.      Reentrant  Installation 

Although  an  optimal  path  cannot  cross,  it  can  cross  the  same  edge  more  than  once,  and  therefore, 
can  also  reenter  a  region.  Recall  from  Chapter  II  that  an  optimal  reentrant  path  will  obey  Snell's  Law  by 
striking  a  boundary  edge  at  its  critical  angle  and  traveling  along  the  edge  just  inside  the  lower  cost  region. 
Since  we  disallow  linear  regions  (e.g.  roads),  such  a  path  may  exit  the  edge  in  only  one  of  two  ways.  It  may 
travel  to  a  terminating  vertex  (Figure  3.12),  where  Snell's  Law  does  not  apply.  Or,  it  may  reenter  the  region 
at  the  Snell's-Law  critical  angle  (Figure  3.13).  In  either  case,  the  path  can  still  be  globally  optimal.  The  former 
case  involving  the  terminating  vertex  is  contained  within  a  proper  WS.  Since  this  path  does  not  reenter  the 
region,  then  it  must  cross  a  different  edge  when  it  reaches  the  vertex.  Such  paths  are  contained  within  proper 
WS's  which  can  be  reached  by  the  rotation  operators  (Theorem  3.3  in  Appendix  A).  However,  the  reentrant 
path  in  the  latter  case  must  reside  within  an  improper  WS.  The  reason  is  that  the  path  reenters  a  region,  and 
thus,  by  definition  (see  Section  3  above)  can  only  be  within  an  improper  WS.  The  rotation  operator  alone 
cannot  reach  improper  WS's. 

A  simple  argument  shows  why  this  is  true.  Suppose  that  some  arbitrary  sequence  of  rotations 
applied  to  a  proper  WS  results  in  an  improper  WS.  Without  loss  of  generality,  we  may  assume  that  at  some 
point  in  the  sequence  a  rotation  operation  transformed  proper  window  sequence  WS  into  improper  window 
sequence  WS  .  This  would  require  that  the  rotation  insert  at  least  one  edge  identifier  into  WS  more  than  once 
to  create  WS  .  But  this  contradicts  the  definition  of  a  rotation  since  the  only  edges  inserted  are  those  which 
are  not  already  in  the  window  sequence.  Therefore,  our  assumption  that  a  proper  WS  was  transformed  into 
an  improper  WS  is  false.  It  follows  that  a  rotation  can  never  create  an  improper  WS  from  a  proper  WS.  As  a 
consequence,  the  rotation  operator  alone  can  never  create  a  WS  with  a  reentrant  path.  We  need  an  additional 
operator  to  reach  improper  reentrant  WS's. 
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Figure  3.12      Critical- Angle  Reflection  Path  (non-reentrant) 
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Figure  3.13      Critical-Angle  Reentrant  Path 
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The  reentrant  installation  operator  perturbs  a  window  sequence  (WS)  by  forcing  it  to  reflect  on 
one  edge.  This  so-called  reflective  edge  is  selected  randomly.  The  selection  process  is  similar  to  that  for  a 
rotation  vertex.  The  reflective  edge  is  randomly  chosen  from  the  set  of  all  crossable  edges  that  bound  regions 
through  which  the  current  WS  passes.  Edges  which  have  crossing  episodes  within  the  current  WS  cannot  be 
reflective  edges.  Transformation  to  the  new  WS  is  a  simple  double  insertion  of  the  reflective  edge  identifier. 
In  Figure  3.14,  window  sequence  {s,l,2,3,g}  becomes  {s,l,4,4,2,3,g}  after  reentrant  installation  on  reflective 
edge  4.  Note  that  the  new  WS  is  improper  because  by  crossing  edge  4  twice  to  reflect,  the  WS  enters  the  same 
cost  region  twice.  However,  the  evaluation  of  WS  {s,l,4,4,2,3,g}  will  discover  if  a  reentrant  path  exists  which 
improves  cost  by  using  two  points  on  edge  4. 


4 

TL 

tx. 

/      3l 

s 

{S,1,2,3,G}->{S,1,4,4,2,3,G} 

Figure  3.14      Installation  of  a  Reentrant  Window  Sequence 

It  is  not  possible  for  an  optimal  path  to  reenter  the  same  region  on  both  of  two  adjacent  boundary 
edges.  Instead,  the  path  must  detour  around  the  common  vertex  or  cut  straight  across  the  region  between  the 
approach  points.  This  fact  is  based  upon  a  proof  given  in  [Mitc90]  which  concludes  that  between  any  critical 
point  of  entry  (exit)  and  the  next  critical  point  of  exit  (entry)  the  path  must  pass  through  at  least  one  vertex. 
Because  of  this,  our  path  annealing  prototype  will  not  create  WS's  with  reentrant  paths  on  two  consecutive 
boundary  edges. 
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It  is  possible  for  optimal  paths  to  cross  a  sequence  of  several  boundary  edges,  reflect  and  reenter 
a  region  at  the  last  edge,  and  double  back  through  the  same  sequence  of  edges  in  reverse  order.  Figure  3.15 
illustrates  the  case  of  an  optimal  path  which  must  cross  several  edges  to  reflect  on  the  last  and  return.  To  reach 
the  improper  WS  containing  this  path,  four  reentrant  installations  must  be  stacked  by  effectively  pushing  each 
through  the  one  preceding  it.  To  reach  such  special  cases  requires  that  the  move  generator  install  reentrant 
paths  against  an  edge  on  which  a  reentrant  already  resides.  Therefore,  we  allow  reentrant  installations  to  push 
(i.e.  stack)  through  one  another,  ensuring  that  such  special  situations  are  reachable. 


Figure  3.15     Reentrant  Path  Crosses  Edges  Multiple  Times 

Recall  that  reentrant-path  optimal  solutions  tend  to  be  rare  because  they  require  particular  cost- 
region  placements  and  angular  alignments  [Rich87,  Mitc90].  Regardless  of  this,  we  give  the  reentrant 
installation  and  rotation  operators  equal  probability  of  selection,  and  let  the  annealing  process  accept  or  reject 
their  resulting  transitions  stochastically.  This  means  that  reentrant  edges  will  be  frequently  installed  into  the 
current  WS.  A  newly  installed  reentrant  edge  which  greatly  improves  local  optimal  path  cost  of  the  current 
WS  is  more  likely  to  be  kept  within  the  current  WS.  This  reduces  the  chance  of  eliminating  good  reentrant 
paths  by  the  vertex  rotation. 
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5.      Improving  Reachability 

The  rotation  and  reentrant  operators  are  capable  of  reaching  all  proper  WS's  and  improper  WS's 
which  contain  at  most  one  reentrant  path  per  edge.  However,  acyclic  improper  window  sequences  (WS)  exist 
that  these  operators  cannot  reach.  Unfortunately,  some  of  these  can  contain  an  optimal  path.  We  can  trace  the 
problem  to  an  interaction  between  the  rotation  and  reentrant  operators.  Consider  the  special  case  of  an  optimal 
path  in  Figure  3.16.  Note  that  the  very  long  edge  bounding  the  top  of  the  narrow  cost-region  is  crossed  several 
times  by  the  optimal  path.  The  vertex  rotation  operator  cannot  create  such  a  WS  because  it  automatically 
removes  edges  which  are  already  in  the  WS.  The  reentrant  operator  only  stacks  reentrants  on  the  same  edge 
it  cannot  install  them  side-by-side.  No  combination  of  these  operators  can  generate  this  WS  from  an  arbitrary 
proper  WS.  Therefore,  the  rotation  and  reentrant  operators  cannot  ensure  complete  reachability  for  all 
possible  globally  optimal  paths. 


Figure  3.16     Optimal  Path  Crosses  Edge  Eq  Multiple  Times  (integers  are  cost 

coefficients) 


In  the  case  of  Figure  3.16,  it  is  possible  to  modify  the  reentrant  operator  so  that  reentrants  can  be 
installed  side-by-side  on  particularly  long  edges.  This  would  require  that  the  algorithm  recognize  boundary 
edges  whose  length  and  geometry  could  allow  multiple  reentrant  optimal  paths.  Then,  when  such  an  edge 
were  selected  for  reentrant  installation,  if  a  reentrant  path  already  existed  on  this  edge,  then  an  additional 
decision  (possibly  random)  would  have  to  made  to  stack  the  reentrant  or  install  it  side-by-side. 
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One  way  to  avoid  operator  modification  is  to  fix  the  source  of  the  problem  -  relative  edge-length. 
When  a  long  boundary  edge  is  situated  among  relatively  short  edges  there  is  an  increased  likelihood  that  an 
optimal  path  may  cross  this  edge  multiple  times.  It  is  tempting  to  believe  that  complete  triangulation  of  all 
regions  will  preclude  any  optimal  path  from  crossing  a  single  edge  more  than  twice.  Unfortunately,  this  is  not 
true.  Consider  Figure  3. 17  in  which  two  near-degenerate  triangular  regions  are  adjacent  with  cost  coefficients 
as  shown.  The  path  from  S  to  G  crosses  the  long  edge  (center)  three  times.  Note  that  by  squeezing  these 
triangles  closer  to  degeneracy,  we  can  eventually  reach  a  geometry  which  ensures  that  the  path  shown  is 
optimal  for  S  to  G. 


Figure  3.17     Optimal  Path  Crosses  Edge  E0  Multiple  Times  (triangular  regions) 

(integers  are  cost  coefficients) 


From  the  above  simple  example  we  see  that  the  problem  concerns  resolution  disparity  in  the  map. 
The  dimensions  that  are  generally  parallel  and  transverse  to  the  long  edge  have  a  relatively  large  resolution 
differential.  The  disproportionately  long  edge  allows  ample  opportunity  for  short  transverse  crossings  to 
greatly  improve  path  efficiency  in  parallel  directions.  In  Figure  3.17,  two  path  segments  that  are  generally 
parallel  to  the  long  edge  become  more  efficient  by  connecting  them  with  a  very  short,  and  therefore,  relatively 
low-cost  transverse  segment.  We  can  easily  prevent  this  problem  with  the  addition  of  one  vertex  at  the  center 
of  the  long  edge  and  two  phantom  edges  connecting  it  to  existing  vertices  in  either  region.  This  does  not 
change  the  representation  of  the  map.  It  simply  balances  the  resolution  of  the  map  in  a  localized  area. 
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Some  simple  preliminary  map  analysis  can  reduce  the  risk  of  having  optimal  paths  with  multiple 
edge  crossings  by  identifying  and  partitioning  particularly  long  edges.  This  can  be  done  by  examining  the 
length  of  each  edge,  e,  relative  to  its  immediate  environment.  Let  B  represent  the  set  of  edges  bounding  the 
two  regions  separated  by  e  but  not  including  e.  Let  V  represent  the  set  of  vertices  on  the  two  regions.  If  the 
length  of  e  is  much  greater  than  the  average  length  taken  over  all  edges  in  set  B ,  and  if  the  maximum  distance 
over  all  perpendiculars  from  points  in  V  to  e  is  much  less  than  the  length  of  e,  then  e  should  be  partitioned 
with  one  or  more  additional  vertices  connected  to  existing  vertices  by  phantom  edges.  Figure  3.18  illustrates 
how  the  long  edge  in  Figure  3.17  should  be  partitioned.  A  comparison  of  cost-coefficients  should  also  be 
made  to  ensure  that  the  weights  of  the  two  regions  separated  by  the  edge  are  large  relative  to  surrounding 
coefficients.  If  such  is  not  the  case  then  the  possibility  of  a  multiple  crossing  on  the  edge  is  minimal  even  if 
it  is  long. 


Figure  3.18     Introduction  of  Additional  Edges  (dotted)  and  Vertex  (small  circle)  to 
Prevent  Optimal-Path  Multiple  Crossings  on  a  Long  Edge 


We  emphasize  that  the  above  procedure  is  heuristic  at  best.  However,  a  completely  thorough 
analysis  is  likely  to  be  tantamount  to  solving  many  weighted-region  problems.  Furthermore,  the  rarity  of 
reentrant-path  optimal  solutions  and  solutions  which  are  not  contained  within  proper  window  sequences  (WS) 
indicates  that  more  detailed  analysis  is  probably  not  worthwhile.  We  desire  that  map  resolution  be  reasonably 
balanced.  In  the  limiting  case,  as  more  vertices  and  phantom  edges  are  added,  the  map  will  approach  a 
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uniform  grid  representation,  and  the  advantages  of  path  annealing  may  diminish.  Therefore,  a  long  edge 
should  be  partitioned  only  in  the  case  that  the  conditions  indicated  earlier  are  extreme. 

6.      Summary  of  Move  Generator 

We  summarize  the  key  features  of  the  move  generator  as  follows.  Its  mechanics  are  simple  and 
involve  only  two  operators  -  vertex/obstacle  rotations  and  reentrant  installations.  It  guarantees  reachability 
for  all  proper  window  sequences  (WS).  The  perturbations  are  small  and  induce  a  neighborhood  structure  on 
the  search  space.  The  cumulative  effects  of  the  operators  are  large,  particularly  at  high  control  temperatures. 
In  the  next  section  we  discuss  the  establishment  of  the  annealing  schedule  and  the  control  of  the  temperature. 

F.   ANNEALING  SCHEDULE  AND  CONTROL 

Although  many  applications  of  simulated  annealing  require  large  amounts  of  computing  time  to  arrive 
at  reasonably  optimal  solutions,  we  have  found  that  path  annealing  performs  reasonably  well  without  the  need 
for  such.  Our  annealing  schedule  is  admittedly  crude  and  uses  only  the  simpler  ideas  proposed  by  other 
researchers.  Path  annealing  efficiency  seems  to  rely  more  on  good  WRP  bounds  and  heuristics  (to  be 
discussed  in  Chapter  IV)  than  on  a  well-tuned  annealing  schedule.  Therefore,  we  employ  the  annealing 
algorithm  for  its  probabilistic  control  of  local  search  through  a  subset  of  the  solution  space. 

While  annealing  schedules  may  differ  somewhat  with  particular  applications,  we  use  the  five  control 
parameters  described  in  Figure  3.19.  The  following  sections  discuss  the  establishment  of  the  particular  value 
for  each  parameter. 


T0  =     starting  temperature  in  weighted  distance  map  units 
Tf  =     freezing  temperature  in  weighted  distance  map  units 

R  =     temperature  reduction  (cooling)  factor;  typically  0.70  <  R  <  0.99 
where  T|+1  =  R  *  T| 

L   =     annealing  chain  length;  maximum  no.  of  attempted  transitions 
per  temperature  Tj 

Ls  =     maximum  no.  of  accepted  transitions  per  temperature  Tj;  also 
known  as  a  cutoff  [John89] 


Figure  3.19     Standard  Annealing  Schedule  Parameters 


64 


1.      Starting  Temperature 

Recall  that  annealing  temperature,  T,  controls  the  shape  of  the  exponential  probability  distribution 
used  to  accept  or  reject  new  solution  samples.  While  all  cost-decreasing  changes  are  accepted,  changes  which 
increase  the  cost  are  accepted  with  probability 

/'(acceptance)  =  Exp(-AC/T)  (Eq  3. 1 1) 

where  AC  is  the  difference  between  the  costs  of  the  new  and  current  solutions  (also  see  Figure  2.6).  The 
acceptance  ratio  over  a  sample  of  transitions  is  estimated  by  [Aart89]  as 

X  =  ( (my  +  (m2  Expi-'EC+ZT) )  /  (rrij+mj  (Eq  3.12) 

where  m  is  the  number  of  cost-decreasing  transitions,  m  is  the  number  of  cost-increasing  transitions,  and 
AC+  is  the  mean  over  the  m  cost-increasing  transitions.  To  ensure  that  annealing  can  sample  across  the 
solution  space  without  trapping  between  high-cost  peaks  and  freezing  too  early,  it  is  desirable  to  set  T  to 
produce  an  acceptance  ratio  close  to  one.  Ratios  of  .90  to  .95  are  generally  considered  close  enough 
[Aart89]. 

To  determine  a  good  starting  temperature,  T  (initial  value  of  T),  we  have  tried  an  empirical 
technique  suggested  by  [Aart89].  Randomly  generate  sample  transitions  in  the  solution  space  without 
rejections.  From  the  sample  values  of  AC  compute  AC+.  Eq  3.12  then  determines  the  value  of  T  which 
produces  the  required  %■  [Aart89]  suggests  an  iterative  approach  reported  to  converge  rapidly  on  a  value  of  T. 

The  conclusions  of  [John90]  suggest  that  simple  application-specific  formulas  can  usually  be 
derived  on  the  basis  of  desired  acceptance  rate  and  a  few  problem-specific  parameters.  Thus,  another  way  to 
determine  a  starting  temperature  value  is  to  consider  the  worst-case  transition  that  can  be  made  by  the  move 
generator  in  the  map.  For  very  complex  problems,  such  an  approach  is  not  always  be  reasonably  possible. 
Fortunately,  our  representation  of  the  WRP  by  window  sequences  allows  efficient  analysis  of  individual 
transitions.  We  desire  the  value  of  T  which  makes  the  acceptance  rate  as  close  to  one  (1)  as  possible.  In  Eq 
3.12,  let  x  =  0.95,  and  replace  AC+  with  an  estimate  of  the  greatest  cost-increasing  value,  Max(AC+). 

To  determine  the  value  of  T  for  an  acceptance  rate  close  to  one,  assume  that  the  generator  applies 
only  a  single  operator  to  the  current  WS,  then  returns  a  new  WS  for  cost  evaluation.  Since  cost-increasing 
reentrant  installations  usually  do  not  result  in  large  cost  changes  and  because  they  are  not  necessary  to  move 
freely  around  the  solution  space,  we  will  consider  only  rotations.  We  wish  to  determine  the  largest  possible 
cost-increasing  transition.  This  transition  will  likely  be  the  site  of  a  long  edge  bounding  two  regions  with  a 
large  cost-coefficient  differential. 
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Intuitively,  Max(AC+)  should  depend  on  an  edge  with  a  large  weight  differential.  However, 
dependence  upon  the  length  of  that  edge  may  not  be  as  clear.  The  reason  that  length  is  a  factor  is  that  a  rotation 
is  followed  by  local  optimization  to  find  cost  (UDP  approximation).  If  this  rotation  has  just  forced  the  current 
WS  across  the  large  weight  differential,  then  local  optimization  will  also  force  the  locally  optimal  path  to  use 
as  little  of  the  high  cost  region  as  possible.  Following  this,  a  second  transition  across  the  other  vertex  of  the 
same  edge  gives  optimization  no  choice  but  to  cross  through  the  high-cost  region.  While  it  is  possible  that 
local  optimization  can  still  dampen  the  cost  difference  of  the  second  transition,  we  assume  the  worst  case. 
Ignoring  smaller  surrounding  effects,  the  largest  change  will  generally  occur  along  the  entire  length  of  the 
edge.  The  situation  is  depicted  in  Figure  3.20. 


locally  optimal  path 
for  WS  {S,a,d,G} 


locally  optimal  path 
for  WS  {S,a,b,c,G} 


Figure  3.20     Maximum  Cost  Difference  Max(AC+)  Occurs  for  WS  Transition 
{S,a,b,c,G}  — >  {S,a,d»G}     (cost  coefficients  are  boxed  integers) 


Thus,  to  estimate  Max(AC+),  we  have  only  to  analyze  the  length  and  weighted-region-cost 
differential  for  every  edge  in  the  map  according  to  the  following  equation: 

Max(AC+)  =  Max        „    .       (L  («,-«,))  (Eq3.13) 

over  all  edges  e     e      2  I  '  \    -i  / 

If  we  assume  that  in  a  random  sample  of  transitions  m  =m  ,  then  Eq  3.12  becomes 

X  =  1/2  (  1  +  Exp(-Max(AC+))  IT)  (Eq  3.14) 

solving  for  T  yields 

r=-Max(AC+)/ln(2x-l)  (Eq3.15) 
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In  this  approach  there  is  no  need  to  conduct  empirical  testing.  One  computation  during  map 
preprocessing  can  establish  a  common  starting  temperature  for  all  problem  instances.  The  major  advantage 
here  is  the  tendency  for  this  method  to  be  independent  of  problem  instance,  depending  instead  on  the 
particular  map.  But  it  is  conservative  and  can  increase  annealing  running  times  unnecessarily.  However,  we 
emphasize  that  this  approach  is  quite  flexible.  It  is  possible  to  conduct  the  analysis  for  MaxCAC^)  on  a  subset 
of  map  edges  confined  to  the  vicinity  of  start  and  goal.  This  variation  is  more  problem-instance  dependent 
while  still  very  efficient 

The  presence  of  obstacles,  again,  requires  special  consideration.  Small  obstacles  with  few 
boundary  edges  will  not  significantly  effect  transitions.  However,  larger  obstacles  can  sometimes  hamper 
lateral  movement  because  they  may  require  acceptance  of  large  cost  changes  to  jump.  If  we  wish  to  set 
starting  temperature  such  that  all  obstacle  rotations  will  be  accepted  in  early  annealing,  it  is  necessary  to 
analyze  their  worst-case  cost  differences  also.  Consider  a  single  obstacle  rotation.  The  worst  transition  tends 
to  occur  when  the  current  WS  is  forced  to  detour  completely  around  the  obstacle  from  a  single  edge  incident 
to  it.  To  estimate  the  value  of  this  worst-case  cost  difference,  we  compute  cost  of  traveling  on  the  boundary 
edges  of  the  obstacle  in  a  closed  loop.  From  this  we  subtract  the  shortest  weighted  length  edge  of  all  its 
boundary  edges  to  account  for  that  portion  of  the  cost  incurred  by  the  original  path  which  passed  near  the 
obstacle. 

2.      Stopping  Criteria 

Freezing  temperature,  T„  is  the  final  value  of  Tat  which  no  significant  cost-increasing  transition 
has  a  reasonable  probability  of  acceptance.  The  reduction  of  unnecessary  search  time  is  as  dependent  upon  T 
as  it  is  on  T  .  Once  T  is  low  enough,  the  current  WS  will  trap  in  a  local  minimum  from  which  it  will  likely 
never  escape  and  in  which  it  can  never  improve  the  cost  beyond  the  lowest  it  has  already  discovered.  At  this 
point  we  desire  that  the  process  terminate  soon.  However,  if  it  is  still  the  case  that  T»  Tf  then  the  algorithm 
will  waste  a  lot  of  time  before  it  halts. 

How  is  it  possible  to  determine  the  proper  value  of  T  when  it  apparently  depends  upon  a  priori 
knowledge  of  the  optimal  solution  cost  and  its  location?  Fortunately,  annealing  runs  exhibit  a  few  similar 
characteristics.  An  annealing  curve  is  a  plot  of  the  mean  solution  cost  vs  the  logarithm  of  temperature.  Figure 
3.21  illustrates  a  curve  which  is  typical  of  most  annealing  runs  [Aart89,  VanL87,  Haje85,  Whit84,  Kirk83]. 
C  is  the  average  cost  over  all  solutions  sampled  at  discrete  temperature  T.  Note  that  the  *-axis  represents 
log(7)  in  the  direction  of  time.  Therefore,  log(7)  decreases  from  left  to  right.  Path-annealing  curves  tend  to 
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be  wavier  at  higher  temperatures  (left  half  of  the  curve)  because  the  starting  solutions  reside  in  cost  function 
valleys.  Path  annealing  climbs  in  and  out  of  many  such  valleys  until  the  value  of  T  is  low  enough  to  stabilize 
(by  trapping)  it  within  a  localized  area  However,  at  lower  temperature  path-annealing  curves  do  resemble  the 
tail  in  Figure  3.21. 


CT  =  average  cost  over  all  solutions 
sampled  at  temperature  T 


iog(T0) 


log(T) 


logCTf) 


Figure  3.21      Annealing  Curve:  Average  Cost  at  T  vs.  Log(T) 


One  way  to  set  T  dynamically  is  to  extrapolate  the  end  of  the  annealing  curve  by  tracking  the 
change  in  mean  cost  [Aart89].  This  does  not  work  well  in  path  annealing  since  even  with  smoothing  the  mean 
cost  can  fluctuate  significantly  at  very  low  temperatures.  The  suggestion  of  [Huan86]  is  simpler  and  a  much 
better  indicator  of  the  freezing  condition  in  path  annealing.  For  a  given  T,  if  the  cost  difference  between  the 
largest  and  smallest  accepted  transitions  is  the  same  (or  very  nearly  so)  as  the  largest  accepted  AC,  then 
apparently  all  solutions  in  the  neighborhood  are  of  very  similar  cost.  At  this  point,  simulated  annealing  should 
default  to  iterative  improvement  and  halt.  To  guard  against  premature  freezing,  we  suggest  that  the  above 
condition  exist  for  two  or  three  consecutive  temperatures. 
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The  above  procedure  stops  the  annealing  algorithm  dynamically.  Recall  that  our  prototype 
actually  uses  a  fixed  value  for  Tf  However,  we  determined  its  value  from  many  observations  of  path 
annealing  using  the  criteria  of  [Huan86]. 

3.      Temperature  Cooling 

There  are  several  sophisticated  cooling  schemes  which  have  been  devised  for  efficient,  adaptive 
reduction  of  temperature  [Huan86,  Lund86,  Aart85].  We  prefer  the  more  simplistic  approach  taken  in  the 
original  work  of  [Kirk83],  also  adopted  by  [John89].  Three  fixed  parameters  control  temperature  cooling:  R, 
L,  and  L  . 

s 

The  reduction  or  cooling  factor,  R,isa  multiplier  used  to  reduce  T  geometrically  according  to 

T.+]=RT.       (typically  0.70  <R< 0.99)  (Eq3.16) 

This  parameter  controls  AT,  and  thus,  the  speed  at  which  the  algorithm  will  approach  T  In  accordance  with 
the  underlying  theory  of  simulated  annealing  [Kirk83]  it  is  best  to  reduce  T  as  gradually  as  possible  with 
values  of  R  closer  to  one.  In  any  case,  there  is  a  tradeoff  between  time  spent  at  each  temperature  value  and 
the  size  of  AT.  Large  AT  approaches  T  relatively  fast,  but  requires  more  time  at  each  value  of  T.  On  the  other 
hand,  smaller  AT  approaches  the  stopping  criteria  much  slower,  but  requires  less  time  at  each  T. 

The  amount  of  search  time  spent  at  each  temperature  is  directly  controlled  by  L.  The  chain  length, 
L,  is  the  maximum  number  of  transitions  attempted  by  the  move  generator  at  each  value  of  T.  The  best  value 
of  L  is  generally  believed  to  approximate  the  size  of  the  local  search  neighborhood  [Aart89].  The  local  search 
neighborhood  is  the  number  of  distinct  states  (i.e.  window  sequences)  reachable  in  transition  one  of  the  move 
generator.  For  path  annealing  the  local  neighborhood  size  is  a  function  of  the  number  of  edges  in  a  current 
WS,  since  the  move  generator  selects  transitions  on  this  basis.  However,  in  contrast  to  the  cardinality  of  a 
solution  set  in  other  problems  (e.g.  the  Traveling  Salesman  Problem),  the  number  of  edges  in  a  WS  changes 
frequently.  Also  note  that  WS  length  varies  greatly  with  the  number  of  bends,  waves,  and  even  cycles. 
Therefore,  we  suggest  the  employment  of  some  average  or  other  stable  value  representative  of  WS  length. 

We  could  use  the  length  of  the  starting  WS  found  by  A*  search  through  midpoint  paths.  However, 
this  WS  is  often  biased  and  may  not  represent  the  size  of  most  neighborhoods.  Thus,  for  our  testing  we  choose 
to  use  a  fixed  value  for  all  problem  instances  of  a  map.  A  reasonable  value  for  L  can  be  derived  from  a  map 
by  using  a  sample  of  straight  lines  equal  in  length  to  the  diameter  of  the  map.  L  is  computed  by  averaging  the 
number  of  boundary  edges  crossed  by  each  line  over  all  lines  in  the  sample.  This  procedure  is  essentially  an 
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estimate  of  map  resolution.  Once  again,  the  advantages  are  simplicity  and  problem-instance  independence 
with  an  option  to  allow  adjustments  to  L  for  particular  problem  instances  if  more  efficiency  is  desired. 

Closely  associated  with  L  is  the  maximum  number  of  accepted  transitions  per  temperature,  L  . 
Recall  that  a  transition  attempted  by  the  move  generator  is  accepted  if  its  corresponding  solution  cost  is  less 
than  the  current  solution  cost,  or  with  probability  P  (see  Eq  3.11)  if  more.  L  is  referred  to  as  a  cutoff Tor  L 
[John89] .  The  purpose  of  a  cutoff  is  simply  to  compensate  for  overestimating  the  starting  temperature,  T  .  We 
desire  a  minimum  value  for  T  at  which  the  acceptance  ratio  x  =  0.95  (or  very  close  to  one).  It  is  better  to 
begin  annealing  at  an  overestimated  value  of  T  ,  rather  than  risk  the  possibility  of  trapping  too  early  in  a  bad 
local  minimum.  Assuming  T  has  been  overestimated,  until  T  approaches  the  proper  value  of  T  ,  each 
consecutive  sequence  of  L  acceptances  will  cause  premature  temperature  reduction  by  Eq  3.16.  L  is 
essentially  an  annealing-specific  heuristic  devised  by  [Kirk83]  to  reduce  search  time  spent  at  high 
temperatures  [John89].  There  appears  to  be  little  published  guidance  as  to  how  to  establish  this  parameter. 
Some  forms  of  the  annealing  algorithm  do  not  use  it.  In  fact,  [John89]  claims  that  its  effect  is  often 
insignificant,  and  its  use  is  usually  unnecessary  if  good  starting  temperatures  can  be  found.  We  should  expect 
some  gain  in  efficiency  by  using  a  cutoff  because  our  starting  temperatures  tend  to  be  higher  than  necessary. 
Indeed,  path  annealing  exhibits  generally  faster  execution  times  with  the  same  performance  for  (0.67)L  <  L 
<  (0.75)L.  Note  that  use  of  this  control  parameter  has  no  effect  when  L  =L. 

G.      SUMMARY 

This  chapter  has  presented  the  framework  for  a  simulated-annealing-based  algorithm  designed  to  solve 
large  instances  of  the  WRP.  We  have  discussed  the  theory  and  practical  application  of  the  algorithm  in  terms 
of  its  five  essential  components: 

•  state  space  representation 

•  initial  solution 

•  cost  function  evaluation 

•  move  generation 

•  annealing  schedule 

We  employ  simulated  annealing  as  a  simple  tool  for  the  control  of  local  search.  In  doing  so,  many  of 
the  specific  design  concepts  (e.g.  the  annealing  schedule)  are  adapted  from  previous  research.  Therefore,  we 
emphasize  that  the  significant  contribution  of  our  work  is  not  in  annealing,  but  rather  in  the  novelty  and  design 
of  our  annealing-based  approach  to  solving  the  WRP.  Chapters  I  and  II  have  already  described  several  of  the 
advantages  offered  by  this  algorithm  over  previous  ones. 
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In  Chapter  IV  we  will  discuss  heuristic  enhancements  and  bounds  which  are  available  to  path  annealing 
(and  some  other  algorithms)  to  increase  performance  and  efficiency.  We  believe  this  collection  of  heuristics 
and  bounding  techniques  is  another  significant  contribution  to  automated  path-planning  research  and  the 
WRP. 
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IV.  EFFICIENCY  ENHANCEMENTS  TO  PATH  ANNEALING 

A.  INTRODUCTION 

In  optimization  problems  it  is  sometimes  possible  to  predetermine  absolute  limits  on  the  location  or  cost 
of  an  optimal  solution.  We  refer  to  such  limits  as  bounds  rather  than  heuristics  since  the  latter  are  generally 
not  absolute  limits.  Both  upper  and  lower  bounds  can  reduce  the  search  effort  by  restricting  the  set  of 
solutions  or  partial  solutions  which  an  algorithm  must  examine.  The  WRP  provides  several  opportunities  to 
devise  bounds  by  reasoning  about  geometric  conditions  in  the  input  maps.  When  absolute  bounds  are 
inadequate  to  reduce  the  amount  of  search  required  to  obtain  solutions  in  reasonable  time,  heuristic  guidance 
can  be  employed.  Although  there  is  no  assurance  that  heuristic  knowledge  will  always  achieve  its  intended 
objective,  good  heuristics  can  be  helpful  [Pear84].  The  next  two  sections  examine  bounds  and  heuristics 
designed  to  increase  the  performance  of  path  annealing.  Some  of  these  also  apply  to  systematic  search 
methods. 

B.  SEARCH  SPACE  BOUNDS  AND  CONSTRAINTS 

1.      Bounding  Ellipse 

In  their  systematic  approach  to  the  WRP,  [Rich87]  and  [Rowe90b]  implement  a  bounding  box 
which  is  guaranteed  to  contain  the  globally  optimal  path.  The  box  is  actually  a  simplifying  device  that 
circumscribes  a  bounding  ellipse  whose  foci  are  start  and  goal  points.  The  bounding  ellipse  is  based  on  the 
weighted  cost  of  a  feasible  path  from  start,  S,  to  goal,  G,  and  the  lowest  cost  coefficient  on  the  map.  For  every 
point,  P,  on  the  ellipse,  the  straight-line  path  SPG  weighted  at  the  lowest  cost  is  equal  to  the  cost  of  the  known 
feasible  path.  Figure  4.1  illustrates  the  ellipse  inscribed  within  its  bounding  box. 
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bounding 


Ellipse  defined  by:    u.*(|SP|+|PG|) 

fi*  =  lowest  cost  coefficient 
D  =  cost  of  initial  solution 


=  D 


Figure  4.1      Bounding  Ellipse  Inscribed  within  Bounding  Box 


To  compute  the  box,  the  implementation  of  [Rich87]  determines  the  lengths  of  the  major  and 
minor  axes  of  the  ellipse.  These  lengths  are  functions  of  the  known  distance  \SG\,  the  lowest  cost  coefficient 
and  the  initial  solution  cost.  Referring  to  Figure  4.1,  let  |i  be  the  lowest  cost  coefficient  on  the  map,  and  let 
D  be  the  weighted  cost  of  the  initial  solution.  Then  the  lengths  of  the  major  and  minor  axes  are 


JrT- 


\SGY 


minor 


D 


(Eq4.1) 


(Eq4.2) 


major       .,* 

These  lengths,  and  the  heading  of  the  line  from  S  to  G,  establish  the  edges  of  the  bounding  box.  Any  path  (or 
partial  path  in  systematic  search)  which  intersects  an  edge  of  the  bounding  box  (or  ellipse)  cannot  be  a 
globally  optimal  because  the  feasible  path  used  to  construct  the  box  must  be  lower  cost.  Thus,  the  search 
space  is  absolutely  bounded. 
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In  path  annealing  we  implement  a  true  version  of  the  bounding  ellipse,  which  eliminates  more  area 
than  the  box.  Path  annealing  can  sometimes  benefit  greatly  by  eliminating  even  a  few  edges  or  edge  parts 
from  the  search  space;  one  less  edge  translates  to  combinatorially  fewer  WS's.  Furthermore,  cutting  a  long 
edge  in  half  results  in  about  one  half  of  the  edge-points  needed  by  UDP  approximation  each  time  this  edge  is 
evaluated  in  a  WS. 

The  cost  of  the  initial  midpoint  solution  returned  by  A*  search  is  an  upper  bound  on  the  cost  of 
the  globally  optimal  path.  However,  we  can  usually  improve  this  bound  by  applying  UDP  followed  by  SPR 
on  the  WS  through  which  this  midpoint  solution  passes.  Let  the  resulting  path-cost  be  D.  The  foci  of  the 
ellipse  are  the  start,  S,  and  goal,  G.  By  definition,  P  is  a  point  on  the  ellipse,  if  and  only  if  the  Euclidean 
distance  of  a  straight  path  from  S  to  P  to  G  weighted  by  p.  ,  is  equal  to  D.  Thus,  a  point,  Q,  inside  the  ellipse 
obeys  the  following  inequality: 

p*  (ISQI  +  IQGI)  <  D  (Eq  4.3) 

We  compute  the  exact  ellipse  as  follows.  Consider  the  two  vertices,  V  and  V  ,  which  define  an 

* 
edge  on  the  map.  Compute  the  cost  of  direct  paths  SV  G  and  SV G  weighted  by  the  lowest  cost,  p.  .  Let  these 

costs  be  C  and  C  respectively.  In  comparing  these  costs  to  the  ellipse  defining  costD,  there  are  three  cases 

to  consider,  one  of  which  has  two  subcases.  Figure  4.2  outlines  each  case  and  the  required  action.  Note  that 

each  boundary  edge  in  the  map  is  considered  once.  Usually  only  a  small  portion  of  the  edges  will  require 

binary  search. 
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For  each  boundary  edge  let  C1  and  C2  be  the  costs  of  the  SV1Gan6  SV2G 
paths  where  V-,  and  V2are  the  vertices  defining  the  edge. 

To  construct  an  exact  bounding  ellipse  from  initial  solution  cost  D,  there 
are  3  cases  to  consider: 

1.  IF(Cr<D)and(C2<D) 

THEN  edge  is  inside  ellipse 
Action:  none 

2.  IF(C7<  Dand  C2>  D)  or  (C7  >  Dand  C2<  D) 

THEN  edge  intersects  ellipse  at  one  point 
Action:  binary  search  between  v1  and  v^to  locate  intersection 
update  map  database  with  new  vertex  for  this  edge 

3.  IF  (Cr>D)  and  (C2>D) 

THEN  edge  intersects  ellipse  at  two  points 
OR  edge  is  completely  outside  ellipse 
Action:  locate  point  at  which  edge  would  be  tangent  to  ellipse 
let  that  point  be  7,  the  virtual  tangent  point 
compute  S-T-G  weighted  by  lowest  cost  coefficient  fi* 
let  this  cost  be  CT 
There  are  2  cases: 
IF  (CT<D) 

THEN  edge  intersects  ellipse  at  2  points 
Action:  binary  search  between  V1  and  T 
binary  search  between  land  V2 
ELSEIF(C7>D) 

THEN  edge  outside  ellipse 

Action:  remove  edge  from  map  database 

Figure  4.2     Cases  of  Bounding  Ellipse  Construction  Algorithm 
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The  third  case  of  Figure  4.2  indicates  that  it  is  sometimes  necessary  to  compute  a  virtual  tangent 
point  and  then  binary  search  for  an  intersections  on  both  sides  of  the  edge.  The  virtual  tangent  point  is  that 
point  on  the  edge  of  consideration  at  which  a  smaller  ellipse  with  similar  shape  would  touch  the  edge.  By 
similar  shape  is  meant  that  the  ratio  of  the  major  to  minor  axis  lengths  remains  constant.  Simple  geometry 
and  the  properties  of  an  ellipse  can  show  that  if  the  virtual  tangent  point  of  an  edge  lies  inside  the  bounding 
ellipse,  then  the  edge  must  intersect  the  ellipse  in  two  locations  (once  at  entry  and  once  at  exit).  Note  that 
relative  to  all  start  and  goal  point  locations,  every  infinitely  extended  line  (edge)  in  continuous  two 
dimensional  space  which  does  not  intersect  the  segment  SG  between  start  and  goal  points,  must  have  a  virtual 
tangent  point.  If  the  line  intersects  segment  SG,  then  the  virtual  tangent  is  taken  to  be  this  point  of  intersection. 

The  time  required  to  compute  the  ellipse  by  our  technique  is  0(e  log(A//e))  where  e  is  the  number 
of  map  edges,  M  is  length  of  the  longest  map  edge,  and  e  is  the  maximum  allowable  error  in  binary  search. 
The  ellipse  bound  is  most  effective  in  reducing  search  space  when  the  initial  A*  solution  is  a  high  speed 
avenue  which  uses  much  of  the  lowest  map  weight.  If  such  is  not  the  case,  then  the  ellipse  may  become  fatter 
than  the  map  itself.  Even  so,  the  time  expended  to  check  each  boundary  edge  for  the  existence  of  an 
intersection  is  negligible.  Furthermore,  it  is  possible  to  determine  if  an  initial  solution  cost  can  generate  a 
bounding  ellipse  that  lies  within  the  confines  of  the  map  border.  Given  a  standard  map  is  100x100  square 
distance  units,  if  the  lowest  cost  on  the  map  p.  =1,  then  an  initial  path  cost  of  281  (=  100  *  V2  *  2)  or  more  is 
guaranteed  to  generate  an  ellipse  larger  than  the  map.  In  such  cases,  there  will  be  no  intersections.  However, 
for  an  initial  path  cost  less  than  281 ,  ellipse  construction  is  usually  worthwhile  regardless  of  the  outcome.  If 
many  intersections  necessitate  binary  searches,  then  search  space  reduction  will  usually  be  significant.  If  not, 
we  lose  very  little  time  for  intersection  existence  checks. 

2.      Ellipse  Improvement 

Once  established,  if  the  regions  which  determined  optimal  cost  coefficient  used  to  compute  the 
ellipse  are  no  longer  contained  therein,  then  a  smaller  ellipse  can  be  computed  on  the  basis  of  the  new  larger 
optimal  cost  coefficient  within  [Rich87].  Path  annealing  provides  still  another  way  to  improve  the  ellipse. 
Since  path  annealing  always  examines  complete  solutions,  the  upper  bound  on  the  cost  of  the  optimal  solution 
can  be  reduced  whenever  a  WS  is  found  whose  locally  optimal  path  has  lower  cost  than  the  best  known 
solution.  These  upper  bound  improvements  provide  more  opportunities  to  recompute  and  shrink  the  current 
bounding  ellipse.  Since  some  reductions  to  the  upper  bound  may  only  be  slight,  it  is  better  to  prearrange  a 
threshold  for  action  on  the  ellipse.  Recomputation  of  the  ellipse  should  only  be  initiated  when  one  or  more 
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edges  will  be  completely  removed  from  the  search  space.  A  new  ellipse  which  only  shortens  existing 
boundary  edges  without  eliminating  them  does  not  remove  window  sequences  from  the  search  space. 

3.      Edge-Pair  Elimination 

The  bounding  ellipse  is  a  global  constraint  on  the  solution  space.  On  the  other  hand,  we  have  seen 
that  Snell's  Law  is  a  local  constraint  on  the  way  optimal  paths  cross  boundary  edges.  Snell's  Law  can 
determine  regions  through  which  globally  optimal  paths  are  not  allowed  to  pass.  Such  regions  may  be 
identified  independently  of  start  or  goal  locations,  as  long  as  they  do  not  contain  either.  This  is  very  valuable 
knowledge  since  it  is  independent  of  the  problem  instance,  and  thus,  computable  as  a  map  preprocessing 
stage.  Such  constraints  can  be  used  by  both  systematic  and  local  search  algorithms.  Although  path  annealing 
is  satisfied  with  finding  near-optimal  paths,  local  regions  which  cannot  contain  optimal  paths  have  little 
potential  for  containing  near-optimal  paths.  While  unusual  problem  instances  are  possible,  we  focus  on  the 
norm. 

a.     Shortcut  Analysis 

We  generalize  and  extend  a  particularly  useful  constraint  that  was  first  proposed  in  limited 
form  as  a  search  pruning  criterion  by  [Rich87]  and  [Rowe90b].  What  we  refer  to  as  shortcut  analysis 
determines  if  any  globally  optimal  path  can  cross  a  specified  edge-pair.  An  edge-pair  is  a  pair  of  crossable 
edges  which  bound  a  common  traversable  region,  and,  therefore,  can  occur  consecutively  within  a  WS.  Note 
that  since  obstacle  edges  are  not  crossable,  then  they  can  never  be  part  of  an  edge-pair.  We  can  prove  that  for 
edge-pairs  with  certain  geometric  arrangements  and  cost  coefficients,  no  optimal  path  can  ever  enter  the 
region  bounded  by  the  pair  from  interior  points  of  both  edges.  Note  that  this  does  not  preclude  the  possibility 
of  bypassing  interior  points  and  enter  the  region  via  its  vertices.  However,  a  path  segment  which  crosses  a 
region  on  a  pair  of  its  vertices  is  considered  to  lie  in  all  WS 's  that  use  this  path  as  a  left  or  right  defining  limit. 
Search  space  redundancy  at  vertex  paths  means  that  bypassing  path  segments  will  also  be  contained  within 
other  window  sequences  (WS).  Interior  crossings  of  edge-pairs  eliminated  by  shortcut  analysis  need  not  be 
checked  for  globally  optimal  paths. 

Shortcut  analysis  considers  each  edge-pair  of  the  map.  Every  edge-pair  has  an  associated  set 
of  three  cost  coefficients.  These  coefficients  correspond  to  the  weights  of  the  three  distinct  regions  which  are 
bounded  by  the  edges  in  the  pair.  Referring  to  Figure  4.3,  consider  the  edge-pair  E  -E  bounding  common 
region  R.  The  set  of  cost  coefficients  corresponding  to  E  -E  is  {p;,p.0,n2 } .  If  |i,  <  [iQ  and  p2  <  \iQ,  then  we 
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consider  R  a  high-cost  region  relative  to  E  -E  .  In  such  a  case,  conditions  developed  in  Theorems  4. 1  and  4.2 
(Appendix  A)  dictate  how  to  determine  if  £  -E  can  be  eliminated  as  an  optimal-path  crossing  site. 


^2          p 

/y^»\ 

\     d2 

V\d2 

t^ 

^^rj 

\         region 

Ro\  \ 

"  DiI/ 

^— — — \  ^^. 

d0\                    Ho 

\ 

Vi, 

O- '--'-- 

fill : 

VN, 

.              t 

S 

i^vvvvvvvvvvvyw»vwy»wvvww.'.v'.^6fy 

a1                 fca 

Figure  4.3      Shortcut  Analysis  on  Edge-Pair  Ea-Eb 


The  proofs  of  Theorems  4.1  and  4.2  permit  us  to  use  the  following  argument.  In  Figure  4.3 
consider  the  continuous  subspace  of  path  segments  connecting  edge-pair  E  -E  which  cross  through  region 
R  from  interior  points  on  each  of  E  and  E  .  If  the  unweighted  distance  of  one  such  path  segment  is 
represented  by  d0,  then  [id  represents  its  weighted  distance.  Also  connecting  each  pair  of  interior  points  of 
E  -E  are  two  perimeter  paths,  which  detour  around  R  by  following  along  the  edges  bounding  R0,  bypassing 
its  interior  points.  Let  the  counterclockwise  perimeter  path  be  P  and  the  clockwise  path  be  P  .  The  weighted 
distances  of  P  and  P.  have  both  a  Fixed  and  variable  component.  The  fixed  component  for  each  perimeter 
path  is  the  sum  of  the  weighted  lengths  of  the  bounding  edges  traversed  by  that  path  which  are  not  in  E  -E.. 
Let  D  and  D  represent  these  fixed  weighted-length  components  for  P  and  P  respectively  (see  Figure  4.3). 
The  variable  components  are  dependent  upon  the  path  segment  crossing  R0.  Let  d  and  d.  represent  the 
variable-component  perimeter-path  distances  from  the  crossing  points  on  E  and  E  .  Then  [id  and  [id  must 
represent  the  corresponding  weighted  distances. 

For  the  moment  we  will  assume  that  regardless  of  the  crossing  location  the  cost  of  using  P 
will  always  be  less  than  the  cost  of  using  P  .  To  see  why  it  may  not  be  possible  for  a  globally  optimal  path  to 
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cross  R  using  interior  points  off  -£  ,  consider  the  implication  of  proving  that  the  ratio  of  the  cost  of  P  to 
the  cost  of  crossing  through  R  is  always  less  than  1 : 

1  > — (Eq  4.4) 

Mo 

Using  the  interior  angle  a  of  £  -£,,  the  fixed  distances  s  and  /  from  the  projected  intersection  of  £  and  £,, 

a     b  a  b 

and  the  Law  of  Cosines,  Eq  4.4  can  be  rewritten  so  that  \x  is  a  function  of  the  crossing  location  on  £  -£  as: 

Ho*    /  (Eq4.5) 

J(s  +  dl)2  +  (t  +  d2)2-2(s  +  d1)  (t  +  d2)Cosa 

If  Eq  4.5  is  satisfied  for  ail  values  of  d  and  d  along  £  and  £  respectively  (i.e.  for  all  path  segments  in  the 
subspace),  then  a  path  segment  through  R  from  interior  points  of  £  -£  will  always  be  more  expensive  than 
a  perimeter  path.  This  function  has  a  maximum  value  which  can  be  found  using  partial  derivatives  with 
respect  to  d  and  d  .  If  the  true  value  of  |i  exceeds  this  maximum  value,  then  no  optimal  path  can  cross 
through  region  R  using  interior  points  of  £  -£  because  a  perimeter  path  is  always  cheaper. 

Theorems  4.1  and  4.2  in  Appendix  A  cover  mathematical  details.  The  constraints  provided 
by  these  theorems  can  tag  or  eliminate  from  a  weighted-region  map  edge-pairs  which  cannot  have  an  optimal 
paths  crossing  them.  Eliminating  very  many  edge-pairs  can  reduce  the  search  effort  required  of  systematic 
search  algorithms,  including  the  A*  search  of  the  edge  dual-graph  used  by  path  annealing  to  establish  an 
initial  solution.  Though  crude,  the  A*  search  for  an  initial  solution  is  a  major  part  of  path  annealing. 
Therefore,  constraints  on  the  size  of  the  edge  dual-graph  which  enhance  A*  search  efficiency  will  benefit  path 
annealing  as  a  whole.  For  many  problem  instances  it  returns  the  window  sequence  very  close  to  or  containing 
the  globally  optimal  path.  The  sooner  annealing  can  find  an  optimal  or  near-optimal  path,  the  more  valuable 
the  algorithm  becomes  in  the  case  of  time-constrained  execution. 

b.     Critical  A  ngle  A  nalysis 

Sometimes  the  geometry  of  an  edge-pair  is  such  that  we  can  avoid  tedious  computations 
required  for  shortcut  analysis,  while  still  eliminating  the  edge-pair.  This  is  particularly  true  when  the  interior 
angle  a  between  an  edge-pair  is  close  to  n  radians.  Critical-angle  analysis  is  a  Snell's-Law  based  technique 
which  uses  the  critical-angle  rays  from  the  four  vertices  of  an  edge-pair  to  determine  if  any  reflective  path 
from  either  edge  can  intersect  the  other.  If  not,  then  it  follows  that  no  Snell's-Law  path  can  exist  between 
interior  points  of  the  edges  because  the  critical  angle  is  the  limiting  case  of  Snell's-Law  bending  on  the  high- 
cost  side  of  a  boundary  edge.  Since  all  optimal  paths  which  cross  the  interior  points  of  a  boundary  edge  (not 
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at  a  vertex)  must  obey  Snell's  Law,  then  no  optimal  path  can  cross  between  interior  points  of  the  edge-pair. 
Thus,  the  edge-pair  can  be  eliminated.  This  is  similar  to  the  concept  of  shadowing  in  [Ross89].  Shadowing 
refers  to  the  propagation  of  constraints  which  restrict  possible  movement  directions. 

A  typical  situation  for  critical-angle  analysis  is  depicted  in  Figure  4.4.  Note  that  |i  <  n  and 
[i  <  \i  otherwise  reflection  cannot  occur  from  within  region  R.  An  algorithm  to  implement  critical-angle 
analysis  begins  by  computing  four  rays,  each  of  which  emanates  from  a  different  vertex  in  edge-pair  E  -E  . 
The  direction  of  each  ray  must  be  inward  toward  the  interior  angle  a  and  must  form  a  critical  angle  with 
respect  to  the  edge  from  which  it  emanates.  Next,  the  intersection  points  P  ,  P  ,  P  ,  and  P  ,  of  the  four  rays 
with  the  opposing  edges  are  computed  by  assuming  that  edges  E  and  E  extend  infinitely.  Finally,  check  the 
positions  of  the  intersection  points  relative  to  the  vertices  of  the  edge  segments.  If  both  pairs  of  intersection 
points  lie  completely  to  one  side  or  the  other  of  their  respective  line-segment  vertices,  then  no  Snell's-Law 
path  can  exist  for  E  -E  ,  and  it  can  be  tagged  such. 
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Figure  4.4      Critical-Angle  Analysis  of  Edge-Pair  Ec-Ed 
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c.      Virtual  Obstacles 

A  given  region  cost  coefficient  may  be  so  high  relative  to  its  surrounding  environment  that 
all  of  its  edge-pairs  can  be  eliminated  from  the  solution  space.  Such  regions  are  called  virtual  obstacles 
[Rowe90b].  Virtual  obstacles  are  equivalent  to  real  obstacles,  unless  the  start  or  goal  resides  within.  It  is 
possible  to  flag  such  regions  and  generate  obstacle  edge-lists  so  that  they  may  be  jumped  during  annealing. 
On  the  other  hand,  this  may  not  always  be  prudent.  Recall  from  Section  III.F.  1  that  large  obstacles  can  hamper 
the  ability  of  annealing  to  move  freely  over  it  because  large  cost-increasing  transitions  may  be  required  to  do 
so.  During  high-temperature  this  would  be  bad  for  annealing,  since  the  search  should  explore  the  solution 
space  across  as  broad  an  area  as  possible.  We  discuss  other  ways  of  handling  this  situation  in  the  next  section 
on  heuristics. 

C.      HEURISTIC  IMPROVEMENTS 

We  have  discussed  restriction  of  the  WRP  search  space  using  both  global  and  local  constraints.  These 
are  strong  restrictions  because  they  provide  an  absolute  guarantee  that  no  globally  optimal  solution  will  be 
excluded.  We  now  present  several  heuristic  techniques  which  can  improve  the  performance  of  path 
annealing.  Heuristics  are  "rules  of  thumb"  which  strike  a  compromise  between  being  simple  and  making 
correct  choices  [Pear84].  Since  it  is  probabilistic  and,  therefore,  cannot  guarantee  the  global  optimum, 
simulated  annealing  is  itself  a  heuristic  approach.  Furthermore,  for  other  optimization  problems,  the 
annealing  technique  usually  requires  larger  execution  times  [Naha85].  However,  the  heuristic  enhancements 
to  be  discussed  demonstrate  the  capability  to  reduce  execution  times  significantly  while  improving  the  cost 
of  the  final  solutions.  In  combination  these  heuristics  make  path  annealing  very  competitive  with  pure  A* 
search  algorithms,  particularly  in  larger  problem  instances. 

1.      Rapid  Cost  Function  Evaluation 

Recall  from  Chapter  III  that  to  find  the  locally  optimal  path  within  a  window  sequence  is  a  two 
step  process.  The  uniform-discrete-point  (UDP)  technique  returns  an  optimal  path  constrained  to  discrete 
points  spaced  at  an  interval  5  on  each  edge  in  the  window  sequence.  Subsequently,  beginning  from  this 
approximation,  single -path  relaxation  (SPR)  uses  a  Snell's-Law  lookup  table  to  iteratively  adjust  crossing 
points  until  no  further  improvements  can  be  made.  For  a  single  window  sequence  (WS),  the  procedure  is 
relatively  efficient.  However,  it  becomes  less  so  when  we  consider  that  the  cardinality  of  the  set  of  all  WS's 
is  at  least  0(v2v)  where  v  is  the  number  of  interior  vertices  in  the  map  [Rowe90b].  Thus,  we  examine  heuristic 
methods  designed  to  increase  the  efficiency  and  frequency  of  cost  function  evaluation. 
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a.     Relaxation  Threshold 

In  a  combinatorial  optimization  problem  the  distribution  of  the  number  of  states  having  a 
given  value  of  cost  is  called  the  density  of  states  [Whit84].  For  some  large  complex  problems  the  density  of 
states  resembles  the  shape  of  a  normal  distribution  function  where  the  tails  represent  global  extremes  -  the 
number  of  maximum  cost  states  on  the  right  and  minimal  cost  states  on  the  left  (see  Figure  4.5).  Having 
bounded  the  search  space  (either  by  a  bounding  ellipse  or  by  the  natural  border  of  the  map)  and  using  a  move 
generator  which  tends  to  remove  cyclic  WS's,  we  may  expect  a  WRP  instance  to  have  a  similar  density  of 
states,  where  each  state  is  a  window  sequence  (WS)  and  its  cost  is  the  cost  of  its  locally  optimal  path.  The 
stochastic  nature  of  the  simulated  annealing  algorithm  requires  that  we  evaluate  every  state  (i.e.  WS) 
encountered  in  search.  However,  a  relatively  low  density  of  optimal  and  near-optimal  solutions  suggests  that 
frequent  applications  of  single-path  relaxation  are  unnecessary.  Although  upward  biased,  uniform-discrete- 
point  (UDP)  approximation  is  fast  and  gives  a  reasonable  estimate  of  the  single-path  relaxation  (SPR)  result. 
For  most  WS's,  UDP  approximation  suffices  to  estimate  their  nearness  to  a  global  optimum.  Furthermore, 
that  UDP  approximation  can  still  effectively  guide  an  annealing-based  search  is  confirmed  by  other 
researchers  who  have  observed  that  exact  cost  function  evaluation  is  not  always  necessary  [Tove88, 
Adam85]. 


Figure  4.5      Density  of  States:  Number  of  States  in  Cost  Interval  Cg 
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On  the  other  hand,  we  do  not  want  path  annealing  to  overlook  an  optimal  or  near-optimal 
solution  if  it  happens  to  sample  one.  This  could  happen  since  the  cost  returned  by  UDP  is  only  an 
approximation.  To  control  this  possibility,  we  establish  the  relaxation  threshold,  C  +M,  where  C  is  the  cost 
of  the  best  known  solution  (also  the  current  upper  bound  on  the  optimal  solution  cost).  The  second  term,  Ak, 
is  a  fixed  value  established  at  the  start  of  path  annealing.  The  relaxation  threshold  represents  the  condition 
which  triggers  single-path  relaxation:  if  the  UDP  cost  is  less  than  or  equal  to  C  +Ak,  then  SPR  is  applied  to 
determine  if  the  refined  cost  of  this  WS  can  improve  C  . 

To  determine  the  fixed  value  of  Ak  for  a  given  problem  instance,  we  assume  a  worst  case 
situation  for  a  UDP  approximation  based  upon  the  discrete  spacing  of  edge-points,  8.  Since  UDP  must 
consider  only  paths  constrained  to  cross  at  edge-points,  then  it  can  be  forced  to  return  an  approximation  with 
path  segments  which  detour  in  non-optimal  directions.  For  relatively  straight  WS's,  the  worst  error  in  UDP 
approximation  generally  occurs  where  the  algorithm  must  select  path  segments  whose  directions  are 
perpendicular  to  the  optimal  direction.  The  least  flexibility  for  choice  of  segment  usually  occurs  in  the  start 
and  goal-containing  regions,  because  the  start  and  goal  are  fixed  points.  Toward  the  middle  of  the  window 
sequence  more  flexibility  is  available,  and  more  path  segments  exist  which  are  less  perpendicular  to  the 
optimal  direction,  and  which  tend  to  self-correct  and  dampen  the  effects  of  errors  made  at  the  start  and  goal. 
Also,  consider  the  locally  optimal  path  of  a  window  sequence  (WS)  which  has  many  bends.  More  bending 
generally  implies  that  the  locally  optimal  path  will  cross  many  end  points  (vertices)  of  boundary  edges.  Since 
the  edge-points  used  by  the  UDP  approximation  always  include  the  vertices  of  a  boundary  edge,  error  is 
minimal  at  these  locations. 

Based  on  the  foregoing  discussion,  we  relate  Ak  to  8  and  the  cost  coefficients  of  the  start  and 
goal-containing  regions.  Figure  4.6  illustrates  a  WS  in  which  a  locally  optimal  path  (dotted)  is  approximated 
by  a  UDP  constrained  path  (solid).  Edge-points  are  shown  as  solid  circles.  We  have  constructed  this  figure 
so  that  the  locations  of  start  and  goal  points  force  initial  path  segments  from  start  and  goal  in  the  UDP 
approximation  to  be  almost  perpendicular  to  the  true  optimal  direction.  Under  the  assumption  that  this  is  the 
worst  case  UDP  approximation  for  8  spacing  and  \i  and  |i  for  start  and  goal-containing  regions,  then  the 
maximum  difference  between  the  UDP  and  SPR  costs  through  this  WS  is  0.58(ji  +(i  ).  Our  empirical 

s       g 

observations  using  vertex  rotations  only  (i.e.  proper  WS's)  confirm  this  calculation.  Being  conservative,  we 
define 

Ak  =  0.58(u  +[i  )  (Eq  4.6) 
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Figure  4.6      Uniform-Discrete-Point  Approximation  of  a  Locally  Optimal  Path 

The  reentrant  installation  operator  has  a  special  relation  to  the  relaxation  threshold.  For  WS  *s 
with  reentrant  paths,  the  cost  difference  between  its  UDP  approximation  and  SPR  may  grossly  exceed  Ait. 
This  happens  when  a  reentrant-installation  move  is  accepted  by  the  annealing  process,  but  this  move  does  not 
improve  cost.  This  is  because  UDP  is  forced  to  reflect  on  edges  installed  for  reentrant  paths  whether  or  not 
they  are  improvements,  while  SPR  simply  ignores  such  reentrant  edges.  This  does  not  invalidate  our 
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calculation  of  relaxation  threshold,  because  these  reentrant  WS's  reside  in  the  middle  to  upper  ranges  of  the 
density  distribution,  and  therefore  never  contain  optimal  paths.  However,  when  a  cost-improving  reentrant 
occurs,  the  cost  difference  between  UDP  and  SPR  for  it  does  not  exceed  A£.  Therefore,  an  optimal  reentrant 
path  will  be  recognized  if  its  UDP  cost  is  below  the  relaxation  threshold,  C  +Ak. 

The  relaxation  threshold  provides  two  advantages  for  path  annealing.  First,  as  implied  earlier, 
it  indicates  when  a  WS  cost  is  far  enough  from  C  that  a  refinement  with  SPR  is  guaranteed  to  be  useless. 
Furthermore,  as  C  is  updated,  the  frequency  of  SPR  application  will  tend  to  decrease.  This  results  in  a 
significant  time  savings  at  high  temperature.  As  temperature  T  decreases,  SPR  may  be  required  more 
frequently.  The  second  advantage  results  from  the  global  effect  of  UDP  approximation.  It  is  generally 
recognized  that  simulated  annealing  performs  best  in  a  search  space  with  a  smooth  cost  function  [John89]. 
Although  UDP  approximation  raises  the  relative  costs  of  all  WS's,  it  tends  to  raise  the  larger  ones  less  because 
their  bending  usually  causes  locally  optimal  paths  to  pass  through  many  vertices.  Recall  that  vertices  are 
always  available  to  UDP  as  edge-points,  and  crossings  through  them  will  be  very  accurate.  Thus,  to  the 
annealing  process  the  search  space  tends  to  be  globally  smoother,  except  where  there  is  good  potential  for 
optimal  or  near-optimal  solutions. 

2.      Caching  Path  Costs  and  Window  Sequences 

It  is  possible  to  stumble  upon  the  globally  optimal  WS  and  corresponding  path  during  annealing. 
So  it  always  makes  good  sense  to  maintain  a  record  of  the  best  known  path  and  update  it  as  necessary.  At  the 
conclusion  of  annealing,  the  final  solution  returned  will  be  that  with  the  best  known  cost,  C  .  While  this  is 
not  standard  annealing,  most  researchers  use  this  variation  (e.g.  [Carr90,  John89,  John90]). 

The  number  of  proper  WS's  in  a  map  is  at  least  0(2V)  where  v  is  the  number  of  interior  vertices. 
Relative  to  many  of  the  NP-Hard  problems,  this  is  not  an  exceptionally  large  search  space.  Bounds  and 
constraints  (e.g.  the  bounding  ellipse)  can  shrink  the  space  even  more.  Therefore,  path  annealing  quite  often 
can  repeat  cost  function  evaluation  on  a  WS  it  has  already  evaluated  before.  Recall  that  cost  function 
evaluation  is  an  expensive  operation.  Therefore,  caching  path  cost  for  WS's  avoids  unnecessary  uniform- 
discrete-point  approximations.  Before  any  WS  is  evaluated  (with  UDP  search  or  SPR),  a  hash  value  is 
computed  as  a  function  of  the  edge  identifiers  in  the  WS.  This  function  may  include  all  identifiers  in  the 
sequence  or  some  predetermined  subsequence.  The  hash  value  is  used  to  check  the  cache  of  previously  stored 
WS's  and  their  associated  costs.  If  the  WS  is  found  in  the  cache,  then  its  cost  is  returned  without 
recomputation.  Otherwise,  WS  cost  function  evaluation  proceeds,  and  the  results  are  cached  for  future  use. 
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Although  we  have  explored  only  a  few  hash  functions,  we  find  that  better  performance  results 
from  those  which  are  computationally  simple  rather  than  those  which  represent  elaborate  attempts  to 
minimize  collisions.  Our  prototype  computes  a  hash  value  as  the  sum  over  all  integer  edge-identifiers  in  the 
WS  (except  for  5  and  g).  Collisions  are  handled  by  linear  chaining  of  linked  lists.  Limited  experiments 
indicate  that  use  of  this  hash  function  results  in  a  20%  to  30%  savings  in  path  annealing  execution  time. 

3.      Move  Generator  Heuristics 

The  generation  of  transitions  generally  requires  less  work  than  does  cost  function  evaluation.  This 
is  a  result  of  the  data  structure  support  discussed  in  Chapter  HI.  However,  since  move  operators  are  the  means 
by  which  annealing  traverses  and  samples  a  large  solution  space,  their  design  is  very  important  to  annealing 
results.  Good  operators  are  apparently  difficult  to  design  because  problems  and  applications  vary  widely 
[John89].  For  example,  annealing  on  the  Traveling  Salesman  Problem  has  been  tested  with  several  different 
operators,  and  some  perform  significantly  better  than  others  [Otte89].  In  path  annealing,  we  desire  that  the 
move  generator  be  capable  of  causing  rapid  movement,  over  a  broad  area  of  the  search  space,  and  with  as 
little  repetition  as  possible.  To  enhance  these  qualities,  we  introduce  several  heuristic  techniques. 

a.     Reduction  of  Repetition 

Recall  from  Chapter  III  that  to  maintain  transition  efficiency,  we  designed  only  two  very 
simple  move  operators:  rotation  (over  a  vertex  or  an  obstacle)  and  reentrant  installation.  We  also  implied  that 
the  cumulative  effects  of  single  applications  of  these  operators  over  time  usually  result  in  great  movement 
across  the  search  space.  However,  when  a  single  vertex  has  many  edges  incident  to  it,  a  WS  which  crosses 
several  of  these  edges  can  often  waste  time  rotating  back  and  forth  across  the  vertex.  The  effect  is  similar  to 
a  physical  standing  wave.  In  general,  the  larger  the  number  of  edges  incident  to  the  vertex,  the  larger  the 
probability  that  this  vertex  will  be  chosen  as  the  site  of  rotation  (See  Figure  4.7).  Caching  of  WS's  helps  to 
reduce  wasted  time,  but  does  not  prevent  each  repetition  from  counting  as  an  attempted  transition,  thereby 
incrementing  the  annealing  chain  parameter,  L  (see  Section  III.F.3).  While  some  repetition  is  good  and  allows 
annealing  to  return  to  more  promising  locations  for  more  thorough  search,  the  standing  wave  effect  represents 
a  stagnation  in  the  sampling  effort. 
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Figure  4.7      Vertex  V  with  Many  Incident  Boundary  Edges 

To  lessen  the  probability  of  window-sequence  standing  waves,  for  each  attempted  rotation 
we  induce  one  additional  rotation.  This  is  done  by  randomly  selecting  an  edge  in  the  new  WS  that  is  incident 
to  the  original  rotation  vertex,  and  forcing  rotation  across  its  other  vertex.  With  this  technique  we  have 
essentially  spread  the  selection  probabilities  over  a  wider  range  of  edges,  making  it  more  unlikely  that  a 
random  rotation  will  undo  the  transition  of  its  predecessor. 

b.     Relation  of  Move  Operators  to  Temperature 

The  double  rotation  technique  discussed  in  die  last  section  tends  to  cause  broader  movement 
across  the  search  space  than  single  rotations  do.  For  some  problem  instances,  we  find  that  use  of  double 
rotation  results  in  the  discovery  of  lower  cost  paths  (even  the  globally  optimal  path)  more  often.  The 
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explanation  for  this  lies  in  the  relation  of  the  magnitude  of  the  attempted  transitions  to  the  annealing 
temperature.  [Whit84]  indicates  that  better  annealing  performance  results  from  matching  move  size  to 
temperature.  High  temperature  annealing  should  attempt  larger  scale  moves,  while  low  temperature  annealing 
should  attempt  smaller  scale  moves.  The  intuitive  explanation  for  this  is  that  at  high  temperature  the  higher 
acceptance  rates  will  permit  uninhibited  sampling  of  the  solution  space.  At  this  time,  large  moves  are  the  most 
efficient  means  for  moving  quickly  over  a  broad  area  of  the  space  and  will  be  accepted  more  easily.  At  lower 
temperatures  it  is  inefficient  to  attempt  large  moves.  Since  they  usually  cause  great  changes  in  the  cost 
function,  many  will  not  likely  be  accepted,  especially  if  the  annealing  process  has  already  found  a  reasonably 
low  cost  state.  On  the  other  hand,  small  scale  moves  can  refine  such  a  state  efficiently  by  making  local 
improvements  or  by  climbing  out  of  localized  minimums  which  are  not  as  good  as  others  close  by. 

Our  prototype  does  not  attempt  to  dynamically  adjust  or  synchronize  the  move  size  with 
temperature.  The  effects  of  doubling  vertex  rotations  seem  to  indicate  that  introducing  multiple  rotations  at 
high  temperatures  could  improve  path  annealing  performance.  However,  the  next  two  sections  explore 
tunneling  and  cycling  which  are  alternate  methods  for  scaling  up  transition  size  for  high  temperature. 

c.      Tunneling 

A  sequence  of  neighboring  window  sequences  within  the  WRP  solution  space  which  have 
similar  costs  that  are  relatively  low  compared  to  the  surrounding  environment  is  called  a  high-speed  corridor. 
A  given  problem  instance  may  have  several  high-speed  corridors.  Furthermore,  these  corridors  may  be 
separated  by  short  or  long  physical  distance,  and  by  high  or  low  weighted  regions.  In  some  instances  high- 
speed corridors  cross  over  one  another,  possibly  in  multiple  locations.  Path  annealing  gradually  tends  to  focus 
its  attention  on  one  or  more  of  these  corridors  as  temperature  decreases.  The  assumption  is  that  during  high 
temperature,  the  annealing  process  will  have  spent  enough  time  roaming  around  all  high-speed  corridors  to 
determine  which  would  be  best  to  refine  at  lower  temperatures.  Thus,  at  some  low  temperature  the  current 
WS  will  have  committed  to  particular  corridors  from  which  it  will  likely  not  escape. 

This  is  essentially  the  behavior  we  desire.  However,  consider  the  following  question:  Have 
other  high-speed  corridors  been  searched  as  thoroughly  as  the  one  in  which  the  process  has  settled  at  low 
temperature?  The  answer  to  this  question  depends  upon  the  starting  temperature,  T '  and  the  annealing  chain 
length,  L,  the  parameter  defining  the  number  of  moves  that  will  be  attempted  at  each  temperature,  T.  Recall 
from  Chapter  III  that  our  method  of  setting  T  ensures  that  the  transition  acceptance  rate  will  be  95%.  This 
implies  that  the  means  for  finding  virtually  all  high-speed  corridors  is  available.  However,  L  should  be  large 


enough  to  ensure  exploration  of  such  corridors  is  sufficient  for  annealing  to  select  and  refine  the  good  ones 
at  lower  temperatures.  In  theory  the  parameter  L  should  be  some  function  of  (most  often  equal  to) 
neighborhood  size  [Aart89].  However,  in  practice  good  values  forL  apparently  vary  from  one  application  to 
another  and  should  probably  be  set  empirically  [John89]. 

Extending  annealing  chain  length,  L,  or  raising  starting  temperature,  T  ,  only  risks  longer 
execution  times  with  little  additional  assurance  of  successfully  finding  and  searching  the  best  high-speed 
corridors.  Instead,  we  suggest  two  techniques  which  take  advantage  of  the  fact  that  the  WRP  represented  as 
a  dual  edge-graph  has  a  smaller  search  space  relative  to  many  NP-Hard  problems. 

The  initial  WS  returned  by  A*  search  of  the  dual  edge-graph  usually  corresponds  to  the 
location  of  a  high-speed  corridor.  As  we  have  said  before,  this  initial  WS  can,  but  does  not  necessarily  have 
to  contain  the  globally  opumal  solution.  Either  way,  we  assume  that  it  has  a  relatively  high  likelihood  of  being 
in  close  proximity  to  the  optimal  path.  Now  suppose  we  determine  the  n  shortest  midpoint  paths  and  their 
corresponding  window  sequences  in  the  dual  edge-graph.  Under  the  above  proximity  assumption,  path 
annealing  started  from  each  of  these  window  sequences  at  a  lower  value  of  T  will  have  a  higher  probability 
of  locating  the  optimal  path.  However,  we  must  be  careful.  The  second  (and  third,  etc.)  shortest  midpoint  path 
within  the  dual  edge-graph  may  very  well  reside  within  the  very  same  high-speed  corridor  containing  the  first 
shortest  midpoint  path.  If  so,  then  we  are  simply  wasting  time  finding  n  best  paths  which  annealing  will 
probably  examine  anyway  because  they  are  all  very  close  together.  Therefore,  what  we  really  desire  are  the 
n  most  high-speed  corridors,  which  may  or  may  not  be  the  n  shortest  midpoint  paths.  This  reasoning  is  very 
similar  to  what  [Tove88]  refers  to  as  a  neighborhood  prejudice  swindle.  The  basic  objective  is  to  reduce 
computing  time  and  increase  the  likelihood  of  finding  good  solutions  by  concentrating  on  the  most  promising 
neighborhoods. 

To  find  a  second  corridor,  we  can  use  knowledge  within  the  initial  WS.  The  WRP  optimal 
paths  maps  generated  by  [Alex89]  reveal  that  for  a  given  fixed  goal  point,  the  vertices  and  boundary  edges  of 
low-cost  regions  tend  to  attract  many  opumal  paths.  Relatively  high-cost  regions  tend  to  repel  them.  On  the 
basis  of  this  observation,  we  can  find  a  second  high-speed  corridor  which  is  physically  separated  from  the 
initial  by  forcing  a  second  A*  search  to  avoid  the  edges  of  regions  most  responsible  for  making  the  initial 
solution  low-cost  Therefore,  by  temporarily  removing  one  or  more  long,  low-cost  edges  from  the  original 
dual  edge-graph,  a  second  A*  search  is  driven  to  find  an  alternate  low-cost  midpoint  path  which  is  usually  in 
a  different  corridor.  The  procedure  is  equivalent  to  temporarily  blocking  a  high-speed  corridor  with  one  or 
more  large  obstacles.  If  the  second  WS  lies  very  near  the  initial  WS,  then  this  is  strong  evidence  that  this 
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corridor  contains  the  optimal  path,  since  A*  search  was  not  able  to  find  a  corridor  with  regions  low  enough 
in  weight  to  draw  it  away  from  the  first. 

At  least  one  of  the  edges  chosen  for  temporary  removal  from  the  graph  must  be  within  the 
initial  WS.  Otherwise,  the  second  A*  search  will  return  the  same  WS.  In  general,  the  edge  in  the  initial  (or 
previous)  WS  which  bounds  the  start  or  goal-containing  region  is  the  one  whose  removal  will  maximize  the 
difference  in  physical  location  between  successive  A*  search  solutions.  The  reason  for  this  is  that  removal  of 
such  an  edge  usually  forces  a  large  shift  in  the  initial  direction  of  search  from  the  initial  region  (containing 
the  start  or  goal).  Consequently,  the  resulting  midpoint  path  may  have  to  use  low-cost  regions  in  areas  of  the 
map  which  were  not  advantageous  when  leaving  the  initial  region  through  the  removed  edge. 

Having  located  several  different  high-speed  corridors,  the  annealing  process  may  proceed 
from  a  lower  temperature  either  sequentially  starting  from  each  or  concurrently  on  all  high-speed  corridors 
together,  returning  the  best  path  found  over  all.  Concurrent  execution  would  require  that  one  initial  WS  be 
selected  as  the  starting  solution.  Since  there  would  be  n  independent  current  window  sequences,  several 
possibilities  exist  for  concurrency.  We  could  apply  random  transitions  by  queuing  the  current  WS's.  Or  the 
move  generator  could  randomly  select  one  current  WS  on  which  to  apply  a  move  operator.  We  could  control 
random  selection  of  a  current  WS  by  annealing  for  a  short  interval  of  time  (perhaps  random),  after  which 
annealing  shifts  to  a  WS  representing  a  different  corridor.  Each  time  this  shift  is  performed,  the  algorithm 
effectively  tunnels  through  high-cost  peaks  in  the  solution  space.  One  way  to  trigger  tunneling  is  to  treat  it  as 
another  move  operator.  It  could  also  be  driven  by  results  in  the  current  corridor.  For  example,  tunnel  to 
another  WS  if  the  current  cost  has  not  improved  after  n  consecutive  transitions.  There  are  certainly  many  other 
possibilities  for  multiple-corridor  execution.  Our  prototype  implements  only  a  single  initial  A*  solution. 
However,  we  have  observed  that  a  second  corridor  generated  as  described  above  increases  the  capability  to 
locate  optimal  paths. 

We  can  also  implement  tunneling  by  relying  upon  high  temperature  annealing  to  locate 
several  WS's  representative  of  different  high-speed  corridors.  Later  at  lower  temperatures  annealing  may 
tunnel  back  to  these  corridors  via  the  WS's.  Since  we  cache  each  new  WS  along  with  its  uniform-discrete- 
point  estimated  cost,  the  process  can  actually  tunnel  to  any  WS  of  its  choosing.  One  problem  with  this  method 
of  tunneling  is  that  it  may  require  very  high  starting  temperatures  to  ensure  broad  uniform  coverage  of  the 
map  and  discovery  of  high-speed  corridors.  Annealing  can  easily  sample  WS's  which  are  generally  physically 
close  together  in  one  corridor,  separated  only  by  a  few  small  cost  gradients.  However,  movement  to  other 
corridors  may  require  jumping  one  or  more  very  high  cost  peaks.  Larger  transition  size  can  help  to  induce 
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greater  WS  movement  (for  example,  by  allowing  multiple  vertex  rotations  for  each  transition  attempted  by 
the  move  generator).  But  to  climb  higher  cost  gradients  still  requires  higher  temperatures.  We  can  save  time 
by  finding  and  caching  the  locations  of  WS's  representing  high-speed  corridors  at  the  start  of  path  annealing, 
This  avoids  the  time  otherwise  required  by  annealing  to  climb  the  upward  gradients  between  these  corridors. 

Recall  that  for  efficient  tunneling  we  desire  a  set  of  WS's  which  lie  in,  and  thus,  represent 
distinctly  different  high-speed  corridors.  Therefore,  between  WS's,  we  need  some  measure  of  physical 
similarity  or  proximity  within  the  search  space.  Window  sequence  (WS)  costs  alone  cannot  distinguish 
physical  location.  One  simple  measurement  is  to  determine  the  set  of  regions  entered  by  each  WS  and 
compute  the  set  difference  between  them.  If  the  resulting  set  is  empty  or  has  very  small  cardinality,  then  the 
WS's  probably  belong  to  the  same  corridor.  Otherwise,  they  are  sufficiendy  distinct.  With  data  structures  to 
support  edge  to  region  translation,  such  a  comparison  could  be  relatively  efficient. 

Our  prototype  employs  a  very  limited  form  of  tunneling.  It  records  each  WS  found  to  contain 
a  path  whose  cost  is  lower  than  the  currendy  best  known.  The  program  does  not  check  that  these  WS's 
represent  distinct  corridors.  Often  they  do  not;  however,  if  several  WS's  have  accumulated  by  the  time  the 
freezing  temperature,  Tf  is  reached,  then  the  set  usually  represents  more  than  one  corridor.  At  temperature 
equal  to  T  the  program  sequentially  tunnels  to  each  WS  in  this  set  To  each  WS  it  applies  pure  iterative 
improvement  by  attempting  L  random  transitions.  At  this  stage  the  relaxation  threshold  is  no  longer  active, 
and  single-path-relaxation  (SPR)  is  applied  to  each  WS.  The  best  path  found  overall  is  returned  as  the 
solution.  Although  this  technique  also  depends  upon  the  ability  of  high  temperature  transitions  to  reach  major 
high-speed  corridors,  it  does  give  some  assurance  that  locations  in  which  good  solutions  were  discovered 
early  have  been  more  thoroughly  explored. 

4.      Faster  Initial  Solutions 

A*  search  through  the  edge  dual-graph  to  obtain  a  starting  solution  is  a  major  component  of  path 
annealing.  Although  its  resolution  is  crude  (midpoints  only),  this  phase  of  the  algorithm  generally  accounts 
for  roughly  10%  of  total  execution  time.  In  Chapter  III  we  argued  that  starting  annealing  from  the  shortest 
midpoint  path  is  most  appropriate.  However,  we  also  mentioned  that  the  primary  purpose  of  A*  search  is  to 
obtain  afeasible  starting  solution.  Having  one  of  the  best  solutions  helps,  but  is  not  necessary. 

Suppose  we  desire  to  implement  tunneling  using  A*  search  to  locate  five  high-speed  corridors 
(first  method  of  tunneling).  Assuming  that  one  A*  search  requires  10%  of  the  total  execution  time,  the  total 
amount  of  time  required  to  locate  five  corridors  now  exceeds  50%  of  the  total  path  annealing  execution  time. 
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This  time  may  sometimes  be  reduced  by  reusing  partial  paths  left  on  the  agenda  generated  by  the  first  A* 
search.  However,  if  the  time  required  to  obtain  initial  corridors  approaches  50%  (or  more),  then  we  might 
reconsider  whether  the  time  advantages  of  our  stochastic  approach  are  still  worthwhile.  As  Chapter  V  will 
demonstrate,  such  execution  times  are  still  less  than  the  times  required  for  a  more  refined  global  A*  search 
from  start  to  goal  with  a  resolution  capable  of  discovering  the  optimal  path. 

However,  with  heavier  dependence  on  the  annealing  phase  of  the  algorithm,  we  can  improve  the 
crude  A*  search  for  starting  corridors.  Recall  that  admissible  A*  search  computes  an  underestimate  to  the 
goal  for  each  midpoint  it  reaches.  This  underestimate  is  the  product  of  the  straight-line  distance  remaining  to 
the  goal  and  the  lowest  cost  coefficient,  p.  ,  and  ensures  that  the  search  returns  the  shortest  (midpoint)  path. 

If  we  assume  that  no  path  exists  between  start  and  goal  which  can  travel  exclusively  in  the  regions  of  weight 

*  • 

(i  ,  then  we  may  relax  the  value  of  [i  by  enlarging  it.  If  our  assumption  is  correct  for  a  higher  optimal  cost 

coefficient,  then  the  A*  search  remains  admissible  and  still  returns  the  shortest  midpoint  path.  If  it  is  incorrect, 
then  the  A*  search  will  be  inadmissable,  and  the  midpoint  path  may  not  be  the  shortest  midpoint  path. 
However,  we  have  saved  some  time  in  finding  an  initial  solution  in  exchange  for  gambling  on  the  ability  of 
annealing  to  start  from  a  possibly  bad  solution  and  still  find  a  good  one. 

In  every  problem  instance  some  threshold  value  for  the  optimal  cost  coefficient  exist  which 
removes  admissibility,  and  consequendy,  the  shortest-path  guarantee.  Values  higher  than  this  threshold  will 
generally  cause  A*  search  to  overestimate  weighted  distance  to  the  goal  from  more  of  the  midpoints.  In  turn, 
the  search  is  driven  to  the  goal  more  directly  and  more  quickly,  because  the  overestimate  increases  its  depth- 
first  behavior.  Using  conservative  optimal-cost-coefficient  overestimates  coupled  with  temporary  removal  of 
low-cost  boundary  edges  from  the  dual  edge-graph,  is  a  good  way  to  efficiently  obtain  an  initial  set  of  WS's 
representing  different  high-speed  corridors. 

5.      Heuristic  Bounds  on  Search  Space 

Section  B.  1  of  this  chapter  described  our  method  for  constructing  the  bounding  ellipse  of  [Rich87] 
and  [Rowe90a]  which  restricts  the  WRP  search  space.  Recall  that  we  use  the  lowest  cost  coefficient,  \i  ,  in 
this  calculation.  The  use  of  n  is  conservative  and  safe,  and  results  in  a  bounding  ellipse  which  cannot  exclude 
any  portion  of  a  globally  optimal  path.  However,  more  complex  maps  may  have  cost  coefficients  which  vary 
over  a  wide  range  of  values.  For  such  maps,  we  indicated  that  the  bounding  ellipses  for  many  problem 
instances  are  often  larger  than  the  map  itself.  This  holds  true  even  when  the  ellipse  is  computed  on  the  basis 
of  a  globally  optimal  path.  The  reason  is  that  for  a  given  arrangement  of  start  and  goal,  travel  through  the 
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lowest-cost  regions  may  require  detours  through  high-cost  regions  which  nullify  their  efficiency. 
Unfortunately,  determining  if  or  when  an  arrangement  of  start  and  goal  can  efficiently  use  the  lowest-cost 
regions  of  a  particular  geometry  appears  to  require  solving  the  WRP. 

To  constrain  a  bounding  ellipse  to  its  minimal  size  requires  a  priori  knowledge  of  the  optimal  path 
cosl  Assume  that  for  a  given  problem  instance  we  have  such  knowledge.  Let  the  cost  of  the  optimal  path  be 
C  .  Also,  let  the  total  unweighted  length  of  the  optimal  path  be  D  .  We  define  its  average  path  weight  as 

\f  =  CID.  (Eq4.7) 

Average  path  weight  is  a  rough  measure  of  path  efficiency.  If  the  globally  optimal  path  has  very  low  average 
path  weight,  then  the  locations  of  start  and  goal  are  apparently  favorable  to  use  of  many  low-cost  regions 
(not  necessarily  including  the  lowest  cost  region)  and  the  optimal  path  is  very  efficient.  On  the  other  hand,  if 
the  optimal  path  has  very  high  average  path  weight,  then  low-cost  regions  either  do  not  contribute 
significantly  or  their  efficiency  is  overshadowed  by  passage  through  high-cost  regions.  With  the  value  of  fi+ 
we  can  construct  a  bounding  ellipse  which  is  smaller  than  that  which  uses  the  lowest  cost  coefficient.  Figure 
4.8  illustrates  what  we  refer  to  as  a  \L*  -ellipse. 

As  implied  earlier,  we  cannot  compute  a  |i+-ellipse  without  prior  knowledge  of  the  optimal  path. 
Using  the  A*  search  through  the  edge  dual-graph  we  can  obtain  a  least  upper  bound  for  C  .  Ideally,  we  desire 
a  greatest  lower  bound  on  |i+.  However,  we  settle  for  a  heuristic  approximation  for  |i+.  Then,  in  exchange  for 
a  small  risk  of  overlooking  the  optimal  path,  we  can  often  achieve  a  marked  performance  improvement  due 
to  a  more  restrictive  search  space. 
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H+  =  CVD*  [i+  (|SP|+|PG|)  >  C* 

C*  =  weighted  cost  of  globally  optimal  solution 

D*  =  unweighted  length  globally  optimal  solution 


Figure  4.8      ^-Ellipse 

One  fast,  yet  conservative  method  of  approximating  p+  is  to  use  the  initial  window  sequence  (WS) 
returned  by  A*  search.  Although  crude  (midpoints  only),  this  search  has  entered  most  regions  of  the  space  in 
the  immediate  vicinity  of  start  and  goal,  so  that,  intuitively,  it  provides  a  reasonable  assessment  of  the 
distribution  of  cost  coefficients  between  start  and  goal.  Let  the  locally  optimal  path  cost  within  this  initial  WS 
be  C  ,  and  let  its  total  unweighted  length  be  D  ,  an  upper  bound  on  the  globally  optimal  path  cost.  To  establish 
a  conservative  estimate  for  p+  we  make  a  simple  heuristic  assumption  about  the  upper  bound  for  the  globally 
optimal  path-cosL  Similar  to  the  reasoning  used  to  determine  relaxation  threshold  in  Section  C.l.a,  we 
compute 

AK  =  0.5(p.  +P-  )/  (Eq  4.8) 

s      g    max  ^ 

where  /       is  the  length  of  the  longest  edge  bounding  the  start  and  goal-containing  regions  with  cost 


coefficients  p.  and  p.  respectively.  A  heuristic  least  upper  bound  on  the  optimal  path  cost  is  C  -AK.  Figure 

S  g  U 

4.6  shows  why  the  discrete  interval  6  is  used  to  determine  relaxation  threshold.  Iniual  A*  search  through 
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midpoint  paths  is  much  less  refined  than  UDP  through  edge-points  with  a  spacing  of  5.  Therefore,  the  factor 
0.56  in  Eq  4.6  is  replaced  by  0.5/      to  obtain  Eq  4.8.  From  the  above  we  estimate  |i+  as: 

H+~(C0-AK)/D0  (Eq4.9) 

This  comes  from  the  observation  that  optimal  paths  generally  do  not  stray  unreasonably  far  from 
the  regions  between  start  to  goal.  In  military  operations  there  are  often  considerations  which  prohibit 
movement  along  paths  with  such  extreme  detours  (for  example,  designated  areas  of  operation  or  the 
requirement  for  adequate  maneuver  space  between  units).  Also  note  that  the  procedure  is  useful  for  both  path 
annealing  and  systematic  search  approaches. 

D.      SUMMARY 

In  this  chapter  we  have  presented  and  discussed  some  techniques  which  can  improve  the  performance 
of  path  annealing.  The  prototype  we  have  designed  employs  most  but  not  all  of  these  enhancements.  We  have 
concentrated  on  bounds  and  heuristics  which  have  shown  the  most  potential  to  maximize  execution  speed  and 
probability  of  location  optimal  paths. 

Throughout  the  first  four  chapters  we  have  stressed  the  performance  advantages  of  path  annealing  over 
purely  systematic  search  methods  such  as  A*  search.  In  Chapter  V  we  will  present  our  own  version  of  a  global 
systematic  search  algorithm  which  is  similar  to  but  faster  and  more  accurate  than  the  wavefront  propagation 
algorithm  referenced  in  Chapter  II.  It  is  against  this  algorithm  that  we  compare  path  annealing. 

We  wish  to  emphasize  that  path  annealing,  though  primarily  a  stochastic  algorithm,  makes  important 
use  of  A*  search.  In  fact,  it  is  fair  to  say  that  path  annealing  draws  a  major  part  of  its  performance  and  power 
from  its  A*  search  component.  Rather  than  just  another  application  of  simulated  annealing,  we  prefer  to 
describe  path  annealing  as  an  intelligent  marriage  of  both  systematic  and  local  search  (both  continuous  and 
discrete)  under  probabilistic  control.  Chapter  V  will  present  empirical  results  from  testing  of  our  path 
annealing  prototype. 
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V.  EMPIRICAL  STUDIES 

A.      TEST  PROCEDURES  AND  MAPS 

1.      Input  Maps 

To  gain  some  understanding  of  how  path  annealing  performs  at  different  levels  of  input  map 
complexity,  we  tested  the  algorithm  on  four  maps.  These  maps  (Figures  5.1, 5.2,  5.3,  and  5.4)  represent  three 
levels  of  increasing  complexity  in  terms  of  resolution  and  cost  coefficient  range.  Cost  coefficients  are  shown 
as  integers  within  resrxxtive  regions,  and  obstacles  appear  as  gray  areas  in  each  map. 

Mapl  (Figure  5.1)  is  the  least  complex,  and  represents  synthetic  terrain  created  and  used  by 
[Rich87].  Map2  (Figure  5.2)  is  of  medium  complexity  and  also  represents  synthetic  terrain  of  our  own  design. 
Map3  and  Map4  (Figures  5.3  and  5.4)  are  the  most  complex  test  maps.  These  maps  represent  our  own 
weighted-region  interpretation  of  a  1000  meter  grid  square  of  actual  terrain  extracted  from  a  standard  military 
map  of  Fort  Hunter-Liggett,  California  [Defe74].  Using  a  computer-assisted  tool  (see  Appendix  B 
mapmaker.pl),  we  constructed  these  maps  on  the  basis  of  combined  elevation,  vegetation,  and  terrain  feature 
data.  Figure  5.5  is  a  plot  of  the  elevation  data  used  to  make  Map3  and  Map4.  Figure  5.6  is  a  magnified 
reproduction  of  this  area  as  it  appears  on  [Defe74].  Figure  5.7  is  an  aerial  photograph  of  the  area  taken  by 
aircraft.  Map3  and  Map4  represent  the  same  section  of  terrain  in  different  seasons.  Map3  represents  a  wet 
season  during  which  the  reservoir  (large  obstacle  in  the  left  half  of  Map3)  is  full.  Map4  represents  a  dry  season 
during  which  the  reservoir  is  completely  dry  (the  case  at  the  time  of  this  writing).  The  validity  of  these  maps 
was  also  confirmed  by  a  site  visit.  However,  we  wish  to  emphasize  that  the  cost  regions  assigned  were  of 
necessity  our  own  interpretation  of  combined  topographic  effects. 

In  an  effort  to  ensure  unbiased  testing,  we  have  also  created  three  additional  test  maps  (Figures 
5.8,  5.9,  and  5.10)  with  the  geometry  of  Map4,  but  in  which  cost  coefficients  have  been  randomly  scrambled. 
The  topological  character  of  each  map  is  identical  to  Map4.  However,  to  create  Map5,  Map6,  and  Map7  we 
randomly  assigned  integer  cost  coefficients  from  the  sets  {1,2,3,.. .,10},  {1,3,5,7,9},  and  {1,4,7}  respectively. 
These  maps  are  intended  to  test  cost  functions  with  varying  degrees  of  smoothness. 
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Figure  5.1      Mapl 


Figure  5.2     Map2 
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Figure  5.3      Map3 


Figure  5.4      Map4 
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Figure  5.5     Plot  of  Elevation  Data  Used  to  Create  Map3  and  Map4 
(elevation  above  sea  level;  tick  marks  represent  12.5  meter  intervals) 


Figure  5.6      Extract  of  Military  Map  [Defe74]  Used  to  Create  Map3  and  Map4 
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Figure  5.7      Aerial  Photograph  Used  to  Create  Map3  and  Map4 


Figure  5.8      Map5 
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Figure  5.9     Map6 


Figure  5.10     Map7 


101 


2.      Control  Algorithm 

In  Chapter  II  we  discussed  previous  approaches  to  solving  the  weighted-region  problem  (WRP). 
To  measure  the  performance  of  path  annealing,  we  would  like  to  place  it  in  direct  competition  with  these  other 
WRP  algorithms.  However,  most  of  the  existing  algorithms  have  limitations  which  prevent  direct  comparison 
on  the  test  maps  we  have  designed  for  path  annealing.  The  Continuous  Dijkstra  Algorithm  [Mitc90]  has  never 
been  implemented.  The  Recursive  Wedge  Decomposition  prototype  of  [Rich87]  is  limited  to  maps  with  two 
distinct  cost  coefficients  and  obstacles.  Furthermore,  it  is  not  designed  to  handle  maps  in  which  vertices  have 
more  than  two  incident  boundary  edges.  A  future  update  to  [Rowe90b]  and  [Alex90]  will  include  a  revised 
prototype  to  account  for  these  restrictions.  However,  this  prototype  will  construct  optimal  path  maps  instead 
of  solving  for  specified  start/goal  pairs. 

a.  Wavefront  Propagation 

A  limited  comparison  of  path  annealing  to  some  of  the  empirical  results  of  [Rich87]  is 
possible  using  Mapl.  Recall  that  Mapl  is  taken  directly  from  the  work  of  [Rich87].  We  can  compare  solution 
quality  directly  in  terms  of  total  path-cost  and  physical  location  for  identical  problem  instances.  However,  a 
direct  comparison  of  execution  times  is  difficult  since  different  machines  and  Prolog  dialects  have  been  used. 
Nevertheless,  we  can  compare  timing  results  with  [Rich87]  indirectly  through  the  grid-based  wavefront 
propagation  algorithm.  To  do  so,  we  have  written  similar  code  to  perform  branch-and-bound  search  on  an  8- 
neighbor  lauice  graph  representing  the  homogeneous-cost  regions  of  Mapl. 

To  provide  the  maximum  advantage  to  the  wavefront  algorithm,  the  search  graph  and  all 
weighted  distances  are  precomputed  independently  of  the  wavefront  algorithm  itself.  The  cost  of  each  arc  in 
the  graph  is  the  product  of  its  Euclidean  length  and  assigned  weight.  For  an  8-neighbor  implementation  there 
are  only  two  lengths:  R  and  RV2,  where  R  is  the  orthogonal  distance  between  grid  intersection  points.  In  the 
same  manner  of  [Rich87],  we  weight  each  arc  in  the  search  graph  by  the  cost  coefficient  of  the  region  in  which 
its  midpoint  resides.  For  our  tests,  grid  resolution  corresponds  to  a  100x100  cell  lattice.  Relative  to  test  cases 
in  [Rich87],  our  grid  is  of  medium  resolution.  [Rich87]  tested  a  low  resolution  (2:1)  64x64  grid  and  a  high 
resolution  (1:1)  128x128  grid.  Thus,  we  expect  solution  quality  which  is  generally  comparable  to  [Rich87]. 

b.  Uniform-Discrete-Point  Global  A  *  Search 

As  noted  in  Chapter  II,  grid-based  wavefront-propagation  solution  path-cost  is  generally 
greater  than  optimal  path-cost  by  some  added  percentage  due  to  the  "stair-step"  effect.  [Rich87]  demonstrated 
that  this  added  percentage  can  vary  randomly  with  resolution.  Besides  the  apparent  random  nature  of  the 
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percent-added  cost  on  a  solution,  the  wavcfront  propagation  has  other  drawbacks.  Assuming  we  know  the 
window  sequence  in  which  a  solution  resides,  then  the  "stair-step"  effect  could  be  eliminated  using  single- 
path  relaxation  (SPR)  to  straighten  the  path.  However,  single-path  relaxation  only  removes  grid  effects  from 
the  final  solution  path.  So,  path-cost  errors  resulting  from  grid  bias  can  cause  the  systematic  wavefront  search 
to  overlook  the  true  optimal  path.  While  higher  grid  resolution  can  improve  accuracy,  this  also  lengthens 
execution  times. 

To  improve  solution  quality  over  grid-based  wavefront  propagation,  we  have  developed  our 
own  simple  algorithm,  which  we  also  compare  against  annealing.  Uniform-discrete-point  global  A*  search 
is  a  generalization  of  the  uniform-discrete-point  (UDP)  method  for  approximating  the  locally  optimal  path  in 
a  WS  to  the  whole  map.  The  algorithm  bears  some  resemblance  to  wavefront  propagation  but  has  several 
important  advantages. 

The  uniform-discrete-point  global  A*  (UDPGA*)  search  technique  is  quite  simple  and 
adapts  naturally  to  the  geometry  and  orientation  of  the  boundary  edges  in  the  terrain  map.  As  with  wavefront 
propagation  grid  size,  UDPGA*  resolution  is  established  a  priori  in  the  form  of  a  discrete  interval,  8.  This 
concept  is  identical  to  that  of  the  same  name  discussed  in  Chapter  III  Section  D.2,  so  the  same  time  trade-off 
applies.  Along  each  edge  of  the  map,  we  locate  uniformly  spaced  discrete  points  where  the  spacing  is  bounded 
above  by  the  value  of  5.  The  algorithm  proceeds  in  two  phases.  The  first  phase  is  a  fast  A*  search  through  the 
dual  edge-graph  (on  midpoints  only).  This  is  done  in  exactly  the  same  manner  as  the  A*  search  for  an  initial 
solution  in  path  annealing.  The  purpose  is  to  obtain  an  early  upper  bound  on  optimal  path  cost  to  construct  a 
bounding  ellipse  (again,  same  manner  as  path  annealing).  Once  the  ellipse  has  bounded  the  search  space,  a 
refined  A*  search  begins  on  the  uniformly  5-spaced  points.  When  the  shortest  path  through  these  points  has 
been  found,  it  is  returned  with  the  WS  in  which  it  resides.  We  apply  UDP/SPR  once  to  that  WS  to  find  its 
locally  optimal  path.  This  path  is  returned  as  the  solution. 

UDPGA*  is  an  approximating  algorithm  in  the  same  sense  as  wavefront  propagation.  It 
solves  the  weighted-region  problem  (WRP)  by  systematically  searching  a  discrete  graph  of  some 
predetermined  size.  This  size  is  a  function  of  the  discrete  interval,  8,  which  sets  the  resolution  of  what  is 
essentially  a  visibility  graph.  However,  UDPGA*  has  several  important  advantages  over  wavefront 
propagation.  First,  it  does  not  simulate  movement  through  regions  as  uniform  incremental  time  steps.  Instead, 
the  algorithm  takes  complete  path  segments  through  regions  via  the  weighted  arcs  of  the  search  graph.  It 
crosses  each  region  in  a  single  step  by  selecting  a  path  segment  connecting  a  pair  of  discrete  points  on 
boundary  edges.  Second,  UDPGA*  makes  more  effective  use  of  the  terrain  map  geometry,  because  the 
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discrete  points  lie  on  boundary  edges.  Path  segments  between  these  points  conform  to  natural  arrangements 
of  edges  and  vertices  in  the  map.  This  tends  to  reduce  the  error  resulting  from  strict  adherence  to  grid  points. 
Third,  UDPGA*  actively  searches  for  and  can  find  reentrant  path  solutions.  Finally,  UDPGA*  makes  more 
effective  use  of  the  bounding  ellipse  than  wavefronL  UDPGA*  can  obtain  an  initial  solution  to  compute  the 
ellipse  quickly  and  exactly  because  its  search  graph  is  oriented  on  boundary  edges  instead  of  a  lattice. 

3.      Validation  Criteria 

We  desire  to  compare  performance  in  terms  of  two  factors  of  weighted-region  problem  solutions: 
total  weighted  path-length  and  total  execution  time.  As  we  indicated  earlier  in  this  chapter,  test  maps  were 
generated  to  study  path  annealing  performance  in  several  cost  function  environments  ranging  from  smooth  to 
hilly.  At  the  same  time  we  wish  to  vary  the  size  of  the  problem  instance  to  examine  time  complexity  as  a 
function  of  problem  size.  We  establish  a  fixed  set  of  12  points  in  the  Cartesian  plane  of  100x100  units  square, 
and  we  generate  66  distinctly  different  problem  instances  by  pairing  these  12  points  as  start  and  goal.  Figures 
5.1 1  through  5.13  illustrate  the  placement  of  these  points.  The  general  location  of  the  points  is  based  on  our 
desire  to  ensure  a  wide  variety  in  size  and  situation  of  problem  instances  while  minimizing  the  advantage  that 
either  algorithm  might  gain  from  a  start  or  goal  point  that  is  close  to  the  border.  This  is  an  important  advantage 
for  both  algorithms  because  it  can  reduce  the  search  space  up  to  75%.  Large  obstacles  can  also  contribute  to 
this.  In  experiments  with  grid-based  wavcfront  propagation,  [Rich87]  refers  to  the  exploitation  of  this 
advantage  as  the  heuristic-selection  strategy.  A  more  specific  local  adjustment  of  the  points  was  made  to 
avoid  having  a  start  or  goal  point  reside  within  a  real  obstacle  for  any  of  the  maps. 
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Figure  5.11     Placement  of  Start/Goal  Points  (Mapl) 


Figure  5.12     Placement  of  Start/Goal  Points  (Map2) 
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Figure  5.13      Placement  of  Start/Goal  Points  (Map3  through  Map7) 


In  order  to  compare  the  algorithms  we  need  a  consistent  measure  of  the  size  of  a  problem  instance. 
The  straight  distance  between  start  and  goal  is  a  rough  measure,  however  it  does  not  account  for  the  resolution 
of  that  area  of  a  map  in  which  the  search  (path  annealing  or  UDPGA*)  is  conducted.  Both  [Mitc90]  and 
[Rowe90b]  determine  problem  size  as  a  function  of  the  number  of  vertices  searched.  The  search  performed 
by  our  algorithms  is  oriented  on  the  boundary  edges.  Thus,  we  estimate  problem  size  as  the  total  number  of 
boundary  edges  reached  by  the  initial  A*  search  through  midpoints.  We  count  each  edge  only  once  regardless 
of  how  many  times  it  might  be  visited  during  this  search.  This  technique  for  estimating  problem  size 
approximates  the  number  of  boundary  edges  inside  the  initial  bounding  ellipse,  since  we  have  found  that 
crude  A*  search  generally  expands  edges  in  an  area  roughly  equal  to  the  size  of  this  ellipse.  The  actual 
bounding  ellipse  is  usually  smaller  because  it  clips  off  portions  of  longer  edges  at  the  limits  of  the  A*  search 
expansion.  Note  that  the  Euler  equations  establish  a  linear  upper  bound  on  the  number  of  vertices  that  can 
exist  in  a  connected  planar  graph  of  E  edges,  if  the  degree  of  all  vertices  is  three  or  more  [Prep87]. 

V  <  2/3  E     if  for  all  vertices,  v.,  Degree(v.)  <  3  (Eq  5. 1 0) 
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Wavefront-propagation  problem-size  would  ordinarily  be  measured  as  the  number  of  grid  cells  expanded  in 
the  search.  However,  in  order  to  have  a  common  measurement  upon  which  to  compare  all  algorithms,  we 
use  the  number  of  boundary  edges  for  wavefront  as  well. 

Execution  time  for  each  algorithm  is  computed  as  total  central  processing  unit  (CPU)  time 
expended  from  the  beginning  of  initial  A*  search  to  the  return  of  the  final  solution.  The  time  required  to 
preprocess  the  map  and  create  necessary  data  structures  is  not  included  in  these  times.  We  have  also  excluded 
most  of  the  CPU  time  required  to  accumulate  and  summarize  statistical  data.  Both  algorithms  are  capable  of 
the  graphical  display  of  outputs.  We  found  that  these  facilities  were  extremely  useful  in  debugging.  While 
maintenance  of  these  displays  expends  a  significant  amount  of  CPU  time,  such  time  is  not  included  in  the 
timing  statistics.  Thus,  total  CPU  time  for  any  given  run  should  be  a  reasonably  reliable  indicator  of  relative 
search  time. 

Once  we  have  established  a  relationship  between  wavefront  propagation  and  uniform-discrete- 
point  global  A*  (UDPGA*)  solution's  quality  and  timing,  we  will  use  UDPGA*  search  as  our  gold  standard 
and  compare  solution  costs  accordingly.  To  compare  the  relative  goodness  of  solutions  for  a  given  problem 
instance  we  take  the  ratio  of  the  total  weighted  path-costs  of  the  path-annealing  solution  to  the  UDPGA* 
solution.  Thus,  a  ratio  value  of  one  indicates  that  both  algorithms  have  achieved  similar  optimal  cost  results 
for  a  given  problem  instance.  A  value  greater  than  one  favors  the  UDPGA*  technique.  However,  as  results 
show,  this  ratio  sometimes  dips  below  one.  This  happens  more  often  when  the  value  of  5  (the  discrete  interval 
defining  the  upper  bound  on  spacing  between  edge-points)  is  not  small  enough  to  ensure  that  UDPGA*  can 
find  the  true  optimal  solution. 

B.      ANALYSIS  OF  TEST  RESULTS 

1.      Testing  of  Grid-Based  Wavefront  Propagation  vs.  UDPGA* 

To  support  the  claim  that  UDPGA*  is  an  effective  algorithm  for  comparing  the  performance  of 
path  annealing,  and  to  relate  both  algorithms  to  the  work  of  [Rich87],  we  present  results  which  compare  our 
prototypes  with  an  implementation  of  grid-based  wavefront  propagation  on  Mapl.  Figure  5.14  shows  the 
results  of  our  algorithms  for  wavefront,  UDPGA*,  and  path  annealing  on  two  problem  instances  tested  in 
[Rich87].  The  UDPGA*  solution  paths  (shown  in  figure)  are  identical  to  those  returned  by  Richbourg's 
recursive  wedge  decomposition  algorithm.  The  path  annealing  solutions  are  identical  to  the  UDPGA* 
solution  paths  with  the  exception  of  two  very  short  segments  in  the  first  problem  instance  (identified  in  the 
figure).  Our  wavefront  propagation  paths  (shown  in  the  figure)  are  somewhat  better  than  those  of  [Rich87] 
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(not  shown).  However,  recall  that  we  use  a  lower  resolution  than  the  maximum  resolution  tested  by  [Rich87] 
(see  bottom  of  Figure  5.14).  Also,  recall  that  the  percent-added  cost  for  wavefront  solutions  will  vary 
somewhat  randomly  with  resolution.  The  large  difference  in  execution  times  between  our  wavefront 
algorithm  and  that  of  [Rich87]  can  be  attributed  to  at  least  two  factors.  First,  each  algorithm  was  executed  on 
different  machine  architectures  with  different  implementations  of  Prolog.  Therefore,  timing  results  can  only 
be  compared  in  a  relative  sense.  Second,  our  wavefront  implementation  does  not  use  the  bounding  ellipse, 
whereas  the  wavefront  implementation  of  [Rich87]  uses  a  precomputed  bounding  box  to  reduce  the  search 
area.  This  also  accounts  for  some  of  the  execution  time  differences  between  our  wavefront  algorithm  and 
UDPGA*.  Computation  of  a  bounding  ellipse  or  box  requires  an  initial  solution  which  wavefront  cannot 
easily  obtain.  Nevertheless,  even  if  such  a  solution  were  provided  at  no  additional  cost,  it  could  not  adequately 
compensate  for  the  execution  time  disparity.  Furthermore,  in  the  more  complex  maps,  the  bounding  ellipse 
often  circumscribes  the  entire  map,  and  therefore,  does  not  help  either  algorithm. 
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Figure  5.14     Mapl:  Two  Problem  Instances  Comparing  Algorithm  Performance 
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To  relate  execution  times  as  a  function  of  problem  size,  we  examine  the  performance  of  each 
algorithm  on  a  set  of  distinctly  different  problem  instances  generated  by  start/goal  pairings  of  the  points 
shown  in  Figure  5.11.  Only  52  of  the  66  possible  paired  cases  are  tested.  The  remaining  12  cases  are  trivial 
and  result  in  straight-line  solutions.  In  such  cases,  there  is  no  space  to  search  because  the  bounding  ellipse  is 
degenerate,  and  therefore,  it  actually  is  the  solution.  For  the  uniform -discrete-point  global  A*  (UDPGA*) 
algorithm  we  set  the  value  of  the  discrete  interval  as  5=3.  This  results  in  a  UDPGA*  resolution  which  is 
usually  more  than  adequate  for  finding  the  globally  optimal  solution.  Also,  this  value  of  5  is  consistent  with 
that  used  in  testing  more  complex  maps. 

The  first  three  plots  in  Figure  5.15a  are  of  running  time  in  CPU  seconds  vs.  problem  size  in  terms 
of  edges  for  wavefront  propagation  (100x100  grid),  UDPGA*  (at  5=3),  and  path  annealing  respectively.  The 
last  plot  in  Figure  5.15a  is  a  quadratic  least-squares  curve  fit  for  points  associated  with  all  three  algorithms. 
We  use  a  quadratic  fit  under  the  assumption  that  the  area  visited  by  wavefront,  and  thus  execution  time, 
should  grow  roughly  as  the  circular  area  of  search  state  expansion  around  the  start  point.  Use  of  a  bounding 
ellipse  and  A*  search  (as  in  UDPGA*)  will  tend  to  flatten  this  circular  area.  However,  [Pear84]  shows  that 
an  admissible  A*  search  still  expands  an  0(n  )  number  of  states.  The  quadratic  curves  in  Figure  5.15a  show 
that  execution-time  growth  rate  of  wavefront  is  much  greater  than  both  UDPGA*  and  path  annealing. 
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Figure  5.15a      Mapl  CPU  Time  vs.  Problem  Size  (in  Edges) 
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We  also  compared  the  timing  results  of  wavefront  propagation  on  the  same  52  problem  instances  as  before, 
but  at  reduced  resolution.  In  this  case,  we  run  wavefront  propagation  on  a  50x50  cell  lattice.  The  results  are 
summarized  in  Figure  5.15b.  Note  that  even  after  halving  the  resolution,  the  execution-time  growth  rate 
remains  significantly  higher  than  both  UDPGA*  and  path  annealing. 
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Figure  5.15b      Mapl  Cost  Ratio  vs.  Problem  Size  (in  Edges) 

We  examined  the  relative  solution  quality  of  the  systematic  search  algorithms,  by  dividing  the 
solution  path-cost  of  wavefront  propagation  by  that  of  UDPGA*  for  the  same  problem  instance  (path 
annealing  will  be  compared  to  UDPGA*  later).  Thus,  a  value  of  1.0  means  that  both  algorithms  obtained 
solutions  with  identical  cost.  Figure  5.16  shows  cost  ratio  vs.  problem  size  for  the  52  instances.  Note  that  in 
all  cases,  UDPGA*  obtains  a  solution  which  is  better  than  wavefront.  This  is  because  the  "stair-step"  effect 
of  wavefront  solution  paths  results  in  the  percent-added  cost  discussed  earlier.  Straightening  the  wavefront 
solution  paths  would  generally  result  in  costs  close  or  identical  to  UDPGA*  as  the  two  instances  in  Figure 
5.14  tend  to  indicate.  However,  more  computation  will  be  required  to  locate  boundary  edge  intersections  and 
establish  Snell's-Law  crossings. 
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While,  our  results  tend  to  highlight  the  disadvantages  of  wavefront  propagation,  we  emphasize 
that  there  are  some  advantages  and  additional  factors  to  consider.  To  its  advantage,  the  wavefront  algorithm 
is  relatively  easy  to  implement.  If  the  terrain  map  is  already  in  digital  form,  then  it  is  likely  well-suited  to  a 
wavefront  approach.  Conversion  of  digital  terrain  data  into  a  connected  planar  map  of  homogeneous-cost 
polygons  can  be  a  very  time-consuming  task.  On  the  other  hand,  we  have  found  that  lattice  generation 
(essentially  digitizing)  of  a  weighted-region  map  is  also  a  time-consuming  task,  depending  upon  the 
resolution  required  to  capture  an  acceptable  level  of  detail.  Defense  Mapping  Agency  provides  terrain  in  both 
digital  and  planametric  (points,  lines,  areas)  forms  [Digi88].  However,  without  data  compression,  digitized 
terrain  will  generally  require  more  raw  storage  space  than  planametric  format.  Furthermore,  many  map 
objects  which  may  affect  cost  per  unit  distance  are  not  easily  coded  in  digital  form.  For  example,  the  location 
of  a  minefield  is  usually  specified  by  reference  coordinates  points  and  boundary  lines. 

On  the  basis  of  the  foregoing  results,  we  can  say  that  the  UDPGA*  algorithm  is  generally  faster 
and  more  accurate  than  wavefront  propagation.  Therefore,  UDPGA*  provides  better  competition  for  path 
annealing  than  wavefront.  The  recursive  wedge  decomposition  algorithm  is  also  faster  and  more  accurate  than 
wavefront  propagation,  though  it  appears  that  it  is  not  as  time-efficient  as  UDPGA*.  However,  wedge 
decomposition  is  guaranteed  to  find  the  globally  optimal  path,  whereas  UDPGA*  can  overlook  it  depending 
upon  the  value  of  8.  Note  that  wedge  decomposition  has  only  been  tested  on  relatively  simple  maps  (such  as 
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Mapl).  To  determine  time  and  solution  quality  relationships  conclusively,  wedge  decomposition  should  be 
compared  directly  to  UDPGA*  and  path  annealing  on  identical  machine  architectures  with  identical  language 
implementations.  Furthermore,  problem  instances  should  vary  over  a  much  larger  range  of  sizes,  geometric 
situations,  and  cost  coefficients. 

2.      Testing  of  Path  Annealing  vs.  UDPGA* 

a.      Testing  of  Small  Problem  Instances 

Having  demonstrated  that  uniform-discrete-point  global  A*  (UDPGA*)  search  is  faster  and 
more  accurate  than  wavefront  propagation,  henceforth,  we  now  focus  our  attention  on  path  annealing 
performance  using  UDPGA*  as  our  gold  standard. 

In  the  case  of  Mapl,  resolution  could  have  been  finer  (for  example,  6=2  or  6=1).  However, 
we  chose  6=3  to  be  consistent  with  our  studies  of  the  more  complex  maps.  (Even  UDPGA*  at  6=3  requires 
over  24  hours  of  CPU  time  to  solve  all  66  cases  for  the  larger  maps.) 


The  path  annealing  schedule  uses  fixed  value  for  T  ,  and  uses  the  cost  of  the  initial  A* 


solution  as  T  . 


•  T  =  cost  of  initial  A*  solution 

•  T  =  1.0 

•  R  =  .80 

•  L  =  5 

•  L  =4 

s 

First  we  consider  a  comparison  of  the  goodness  of  solutions  as  measured  by  the  ratio  of  solution  costs.  In 
Figure  5.17  we  plot  the  ratio  of  solution  costs  of  path  annealing  to  UDPGA*  as  a  function  of  the  size  of  a 
problem  instance  in  terms  of  the  number  of  edges.  The  inset  in  this  figure  indicates  some  key  statistics 
computed  over  the  52  cases.  Note  that  the  maximum  difference  from  the  UDPGA*  solution  was  less  than 
5%,  and  that  the  majority  of  points  lie  on  the  axis  (i.e.  at  a  1:1  ratio). 
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Figure  5.17     Mapl  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size 

A  major  advantage  of  path  annealing  is  execution  time  savings.  Although  we  designed  path 
annealing  to  be  most  efficient  for  larger  problem  instances,  it  does  surprisingly  well  even  for  relatively  small 
instances.  Figures  5.18  and  5.19  are  plots  of  central  processing  unit  (CPU)  time  required  as  a  function  of 
problem  size  for  UDPGA*  and  path  annealing.  These  plots  contain  the  same  52  problem  instances  compared 
to  wavefront  propagation  earlier.  However,  by  not  displaying  the  wavefront  data,  we  are  able  to  expand  the 
CPU  time  axis  to  better  show  the  relationship  of  path  annealing  to  UDPGA*.  Even  for  these  smaller  instances 
the  plots  indicate  that  path  annealing  has  lower  average  time  complexity.  To  partially  confirm  this,  we  again 
apply  a  quadratic  least-squares  curve  fit  to  each  plot.  The  resultant  timing  curves  are  shown  in  Figure  5.20. 
A  generalization  about  the  quality  of  path  annealing  vs.  UDPGA*  cannot  be  made  on  the  basis  of  these 
problem  instances,  since  they  are  relatively  small. 
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Figure  5.18      Mapl  UDPGA*  CPU  Time  Required  vs.  Problem  Size  (Edges) 
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Figure  5.19     Mapl  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (Edges) 


115 


260-- 


158- 

CPU 

Time     lee- 

(sec) 

58- 


Map1 

Quadratic 

Least-Squares 

Curve  Fit 


Problem  Size  (Edges) 


78 


Figure  5.20     Mapl  Quadratic  Least-Squares  Curve  Fit:  CPU  Time  vs.  Problem  Size 

As  a  final  comparison  between  path  annealing  and  UDPGA*  for  Mapl ,  we  plot  the  solution 
cost  ratio  against  time  ratio  for  each  problem  instance  in  Figure  5.21.  This  plot  provides  a  rough  indication 
of  the  relative  time-cost  trade-offs  between  the  algorithms.  If  we  consider  the  point  (1,1)  as  the  origin,  then 
the  four  quadrants  define  classes  which  categorize  test  results  as  good,  bad,  or  in  between.  A  test  run  which 
falls  in  quadrant  I  (upper-right)  indicates  bad  path  annealing  performance  since  both  time  and  cost  ratios 
exceed  one.  On  the  other  hand,  a  point  which  occurs  in  quadrant  III  (lower-left)  indicates  good  path  annealing 
performance.  Keep  in  mind  that  this  performance  measure  is  always  relative  to  UDPGA*  which  does  not 
guarantee  optimal  solutions  either.  However,  the  fact  that  a  large  number  of  test  points  reside  on  the  time  ratio 
axis  (i.e.  path  annealing  cost  /  UDPGA*  cost  =  1 .0)  is  a  reasonably  good  indication  that  many  true  optimal 
paths  have  been  discovered. 
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Figure  5.21      Mapl  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 

b.     Testing  of  Moderately  Complex  Problem  Instances 

For  the  remaining  tests  we  use  the  standard  set  of  start/goal  points  defined  earlier  in  this 
chapter.  Recall  that  this  set  generates  66  distinct  problem  instances.  The  series  of  plots  introduced  in  the  last 
section  will  be  the  common  basis  for  discussion  of  results.  In  this  section  we  examine  the  results  on  Map2 
which  has  over  twice  as  many  edges  and  regions  as  Mapl.  This  map  will  compare  performance  of  the 
algorithms  at  a  larger,  yet  intermediate  level  of  complexity. 

In  these  tests,  path  annealing  solutions  are  compared  to  UDPGA*  solutions  with  5=3  and 
5=6.  We  used  the  following  annealing  schedule: 

m  T  =  1.5  x  (cost  of  initial  A*  solution) 

•  T  =  1.0 

•  R  =  .90 

•  L  =15 

•  L  =11 

s 

Figures  5.22a  and  5.22b  display  cost  ratio  vs.  problem  size  for  comparison  of  path  annealing  against 
UDPGA*  at  5=3  and  5=6  respectively.  Although  very  slight,  there  is  a  difference  between  plots  in  the 
general  height  of  the  points  above  the  ;c-axis  (where  cost  ratio  =  1).  This  is  reflected  by  the  small  difference 
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in  mean  cost  ratio  between  the  plots  as  observed  in  the  inset  statistical  summaries.  We  should  expect  this 
since  UDPGA*  resolution  is  relaxed.  Note  also  that  the  quartiles  (in  statistical  summary  insets  of  Figures 
5.22a  and  5.22b)  are  very  small  for  both  point  sets,  because  the  majority  of  the  points  rest  very  close  to  or  on 
the  x-axis.  We  attribute  tiny  deviations  to  rounding  errors  accumulated  during  total  path  cost  computation 
more  so  than  physical  deviation  from  an  optimal  path. 
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Figure  5.22a     Map2  Cost  Ratio  (Path  Annealing  /UDPGA*)  vs.  Problem  Size  (Edges) 
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Figure  5.22b     Map2  Cost  Ratio  (Path  Annealing  /UDPGA*)  vs.  Problem  Size  (Edges) 
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The  difference  in  means  between  6=3  and  5=6  is  so  small  that  the  Figures  5.22a  and  5.22b 
do  not  adequately  show  how  the  value  of  5  can  impact  on  the  solution  quality  of  UDPGA*.  To  see  this  effect, 
we  executed  UDPGA*  on  the  same  66  problem  instances  in  Map2  for  5=12.  Figure  5.23  is  a  plot  of  the  cost 
ratios  for  solution  cost  of  UDPGA*  at  5=12  over  cost  at  5=3.  This  figure  shows  that  solution  quality  degrades 
significantly  as  6  increases. 


1.3i 

Map  2 

1.2- 

■ 

6=12/6=3 

Cost  Ratio    1*1' 

B 

■ 

■  .                 ■ 

UDPGA*  at 
6=12/5=3 

■  ■     ■     ■ 

■_-»ir"     t  :    ."  -    -   i-                   l     '               i 

25             58 

75 

188"     "125           158          175 

6.9- 

Problem  Size  (Edges) 

8.8 
8.7- 

Mean 
1.013 

SD       Quart  Dev                Range           SE  aean 
9   033                 0.005                 9   244                 0.004 

8.6- 

M  i  n  ilium 

Quart  ile    1      Quart  He   2      Quart  He   3            Haxlaua 

8.5 

0.975 

1.000               1.002               1.010               1.219 

Figure  5.23     Map2  UDPGA*  Cost  Ratio  (6=12  /  6=3)  vs.  Problem  Size  (in  Edges) 

The  next  set  of  plots  (Figures  5.24  through  5.27)  show  the  effects  of  varying  5  (resolution)  on  CPU  time. 
Recall  that  5  defines  the  upper  bound  on  the  distance  between  edge-points.  As  we  expect,  the  time  required 
for  UDPGA*  at  6=6  is  less  than  that  required  at  5=3.  Comparison  of  the  quadratic  curve  fits  (Figure  5.28) 
shows  the  effect  of  increasing  UDPGA*  resolution.  The  dotted  lines  indicate  that  doubling  resolution  (i.e. 
halving  the  value  of  6)  results  in  a  four-fold  increase  in  the  execution  time  requirement. 
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Figure  5.24     Map2  UDPGA*  at  8=3:  CPU  Time  Required  vs.  Problem  Size  (Edges) 
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Figure  5.25     Map2  UDPGA*  at  5=6:  CPU  Time  Required  vs.  Problem  Size  (Edges) 
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Figure  5.26     Map2  UDPGA*  at  5=12:  CPU  Time  Required  vs.  Problem  Size  (Edges) 
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Figure  5.27      Map2  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (Edges) 
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Figure  5.28     Map2  Quadratic  Least-Squares  Curve  Fit  for  CPU  Time  vs.  Prob  Size 
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Finally,  consider  Figures  5.29  and  5.30  which  are  the  cost-ratio  vs.  time-ratio  plots  when  5=3 
and  5=6  respectively.  For  5=3  more  points  reside  further  to  the  left,  which  is  consistent  with  the  overall 
increased  time  requirement  for  UDPGA*.  However,  the  cost  ratios  change  very  little  between  5=3  and  5=6. 
For  path  annealing,  this  cost-ratio  stability  between  UDPGA*  resolution  changes  can  be  attributed  to  a  high 
rate  of  success  by  initial  crude  A*  search  in  locating  the  optimal-path-containing  window  sequence  or  one 
which  is  close  to  it.  In  the  following  subsections,  we  shall  examine  the  results  of  tests  for  which  the  initial 
crude  A*  search  is  not  quite  as  successful.  This  will  expose  a  weakness  of  path  annealing  -  its  dependence 
on  good  starting  solutions. 
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Figure  5.29     Map2  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*)   5=3 
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Figure  5.30     Map2  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*)   5=6 
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c.      Testing  Real  Terrain 

In  this  section  we  present  the  results  of  tests  conducted  on  Map3  and  Map4  which  model 
actual  terrain.  These  maps  have  about  three  times  the  number  of  edges  and  regions  as  Mapl.  It  is  important 
to  realize  that  the  cost  functions  in  these  maps  are  relatively  smooth  because  they  approximate  the  cost  of 
movement  as  determined  from  real  elevation  and  vegetation  data.  In  addition  to  the  large  reservoir,  there  are 
also  cost  coefficient  differences  between  the  maps  which  account  for  seasonal  changes  in  trafficability. 
However,  we  have  assumed  that  regional  topology  remains  unchanged  from  wet  to  dry  season.  We  have  not 
superimposed  tactical  data  that  might  induce  drastic  cost  differentials  across  boundaries,  although  the 
elevation  data  does  tend  to  cause  such  in  a  few  locations.  In  these  maps  we  set  5=3  to  achieve  relatively  high 
quality  UDPGA*  solutions.  The  path-annealing  schedule  is  adjusted  somewhat  to  account  for  longer  window 
sequences  which  will  result  from  the  complexity  in  these  maps.  We  have  extended  the  annealing  chain  length 
and  cutoff  to  20  and  15  respectively: 

•  T  =  1.5  x  (cost  of  initial  A*  solution) 

•  T  =  1.0 

•  R  =  .90 

•  L  =20 

•  L  =15 

s 

Figures  5.27  and  5.28  are  plots  of  cost  ratio  as  a  function  of  problem  size  for  runs  on  Map3 
and  Map4  respectively.  In  both  maps  path  annealing  does  reasonably  well  for  such  complex  maps.  It  is 
interesting  to  note  that  there  does  not  appear  to  be  any  significant  decrease  in  solution  quality  for  path 
annealing  as  the  size  of  problem  instances  increases.  Furthermore,  if  we  assume  for  a  moment  that  6=3  is  a 
fine  enough  resolution  to  ensure  that  UDPGA*  does  not  overlook  an  optimal  path,  then  all  but  a  few  of  the 
path  annealing  solutions  fall  within  a  5%  margin  of  error.  We  attribute  this  behavior  to  the  success  of  the 
crude  initial  A*  search  which  often  finds  a  window  sequence  in  the  vicinity  of  the  optimal  path.  We 
emphasize  that  the  success  of  path  annealing  is  often  dependent  on  the  power  of  this  initial  crude  systematic 
search. 
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Figure  5.31      Map3  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size  (Edges) 
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Figure  5.32      Map4  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size  (Edges) 

Algorithm  timing  comparisons  on  Map3  and  Map4  yield  similar  results.  Therefore,  in 
Figures  5.33  and  5.34  we  present  only  the  plots  for  Map4.  The  important  difference  from  what  we  have 
already  viewed  is  the  fact  that  these  time  plots  provide  empirical  evidence  of  average  time  complexities  for 
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very  large  problem  instances  (300+  edges)  without  extrapolation.  Another  quadratic  curve  fit  (Figure  5.35) 
shows  that  path  annealing  timing  requirements  rise  very  slowly  and  are  almost  linear  as  a  function  of  the 
problem  size.  The  reason  for  this  behavior  is  that  the  annealing  algorithm  is  a  random  sampling  mechanism 
whose  annealing  schedule  predetermines  to  a  large  extent  its  running  time.  The  reason  why  these  timing 
results  actually  do  vary  with  problem  size  is  that  the  general  length  of  window  sequences  determines  how 
quickly  the  locally  optimal  path  can  be  found.  Longer  WS's  require  somewhat  more  time.  Larger  problem 
instances  will  generally  have  to  optimize  longer  WS's. 
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Figure  5.33      Map4  UDPGA*  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 


CPU 
Time 
(sec) 


4888 
3588 
3888 
2580 
2888 
1588 
1800 
588 


Map  4 

Path 
Annealing 


-U- 


i  * 


58 


108 


150 


208 


258 


388 


v.  Problem  Size 
(Edges) 


358 


Figure  5.34     Map4  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.35     Map4  Quadratic  Least-Squares  Curve  Fit:  CPU  Time  vs.  Problem  Size 

The  cost-ratio  vs.  time-ratio  plots  in  Figures  5.36  and  5.37  (for  tests  on  Map3  and  Map4 
respectively)  reflect  the  reduced  CPU  time  requirement  of  path  annealing.  The  few  points  which  remain  to 
the  right  of  the  cost-ratio  axis  (time-ratio  =  1)  correspond  to  the  smallest  problem  instances.  Also,  note  that 
almost  no  path  annealing  runs  significantly  improve  the  optimal  cosL  As  demonstrated  in  the  next  section, 
this  is  usually  a  good  indication  that  the  UDPGA*  solutions  are  optimal.  The  reason  is  that  when  UDPGA* 
overlooks  true  optimal  solutions,  some  path  annealing  runs  usually  discover  a  few  better  solutions  (even 
optimal)  than  those  returned  by  UDPGA*.  The  result  will  be  a  few  points  which  dip  below  the  time-ratio  axis 
(cost-ratio  =1). 
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Figure  5.36     Map3  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 
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Figure  5.37     Map4  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 

As  a  final  comparison,  we  present  the  physical  locations  of  the  solution  paths  returned  by  the 
algorithms.  Figure  5.38  and  5.39  illustrate  the  test  maps  with  all  solution  paths  drawn  between  respective 
start/goal  points.  We  provide  these  pictures  merely  as  a  visual  demonstration  to  show  that  the  location  and 
shape  of  annealing  solution  paths  compare  favorably  with  those  of  UDPGA*.  The  majority  of  the  solution 
paths  are  identical.  A  few  solutions  have  slight  physical  differences  which  have  little  impact  on  corresponding 
total  path-cost 
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Figure  5.38      Map4  Solution  Paths  Found  by  UDPGA* 


Figure  5.39     Map4  Solution  Paths  Found  by  Path  Annealing 
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d.      Testing  Maps  with  Highly-Variable  Cost  Coefficients 

The  next  series  of  tests  is  designed  to  determine  how  well  path  annealing  performs  on  maps 
with  generally  hilly  cost  functions.  To  some  extent,  these  tests  indicate  the  kind  of  performance  we  might 
expect  if  we  were  to  model  extremely  complicated  tactical  situations  with  a  variety  of  overlapping  and 
interacting  cost  coefficients  (as  discussed  in  Chapter  I).  Recall  that  for  Map5,  Map6,  and  Map7  we  have 
randomly  assigned  region  cost  coefficients  drawn  respectively  from  the  three  sets:  ( 1,2,3,4,5,6,7,8,9,10}, 
{ 1,3,5,7,9} ,  { 1,4,7} .  Therefore,  we  describe  the  general  character  of  each  map  as  follows: 

•  Map5  -  uniformly  choppy;  many  shallow  local  minima 

•  Map6  -  choppy  but  irregular;  deeper  local  minima 

•  Map7  -  high  cost  peaks  and  deep  valleys;  several  very  deep  local  minima 

For  this  set  of  tests  we  have  again  chosen  5=3  for  the  uniform-discrete -point  global  A*  (UDPGA*)  search 
algorithm.  We  modify  the  path-annealing  schedule  to  conduct  a  more  thorough  local  search  at  each 
temperature  by  raising  the  reduction  factor  R  slightly.  We  also  start  at  a  somewhat  higher  temperature  to 
delay  the  onset  of  freezing,  and  hopefully,  to  enable  the  annealing  algorithm  to  climb  out  of  deeper  local 
minima.  The  new  schedule  is  as  follows: 

•  T  =  2.0  x  (cost  of  initial  A*  solution) 

•  T  =1.0 

•  R  =  .92 

•  L  =20 

•  L  =15 

s 

We  expect  that  larger  numbers  of  deeper  local  minima  will  severely  tax  the  ability  of  path  annealing 
algorithm  to  find  good  solutions.  This  conjecture  is  partially  confirmed  by  the  cost-ratio  vs.  problem  size 
plots  in  Figures  5.40  through  5.42.  While  path-annealing  solution  quality  on  Map5  is  somewhat  worse  than 
it  was  for  smoother  maps,  we  can  see  a  noticeable  trend  going  to  Map6  and  Map7  as  more  points  wander 
higher  above  the  Jt-axis.  On  the  other  hand,  several  points  below  the  x-axis  indicate  that  UDPGA*  also  has 
difficulty  finding  true  optimal  solutions.  The  fact  that  more  points  lie  above  than  below  the  *-axis  is 
reasonable  since  we  consider  UDPGA*  our  gold  standard,  and  because  it  is  a  systematic  search  which  looks 
everywhere  a  with  finite  resolution. 
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Figure  5.40     Map5  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size  (Edges) 
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Figure  5.41      Map6  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size  (Edges) 
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Figure  5.42      Map7  Cost  Ratio  (Path  Annealing/UDPGA*)  vs.  Problem  Size  (Edges) 
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Although  the  solution  cost  from  path  annealing  is  significantly  more  than  UDPGA*,  we 
emphasize  the  following  two  points.  First,  as  mentioned  earlier,  simulated  annealing  in  general  does  not 
perform  well  on  search  spaces  whose  cost  functions  have  many  deep  local  minima.  The  reason  is  that  such 
deep  valleys  more  easily  trap  the  annealing  algorithm,  preventing  it  from  sampling  other  areas  of  the  space. 
Second,  in  these  tests  we  anneal  from  a  single  initial  solution.  If  this  solution  lies  within  a  deep  local 
minimum,  then  path  annealing  might  not  be  able  to  escape.  Raising  the  starting  temperature  is  one  way  to 
prevent  such  behavior.  However,  we  believe  that  this  is  not  the  most  effective  use  of  time  in  a  simulated- 
annealing  approach  to  route-finding.  Limited  testing  indicates  that  better  performance  can  be  achieved  for 
minimal  time  penalties  by  using  the  tunneling  approach  discussed  in  Chapter  IV.  Instead  of  annealing  from 
a  single  deterministic  initial  solution,  it  is  more  advantageous  to  begin  from  several  which  are  physically 
scattered  around  the  map.  Our  concept  of  crude  (boundary-edge  midpoint)  A*  searches  can  serially  find 
several  such  paths  relatively  quickly.  However,  more  efficient  methods  for  doing  so  in  a  single  sweep  should 
be  investigated. 

An  analysis  of  the  CPU  time  vs.  problem  size  once  again  illustrates  a  significant  time 
advantage  for  path  annealing,  even  with  the  annealing  schedule  modified  to  search  more  thoroughly  (see 
Figures  5.43  through  5.51).  With  regard  to  the  UDPGA*  algorithm,  we  can  identify  an  interesting  trend  in 
the  point  spread  going  from  smooth  cost  coefficients  to  very  rough.  Consider  the  UDPGA*  timing  results 
illustrated  in  Figures  5.33, 5.43, 5.46,  and  5.49,  corresponding  to  Map4  through  Map7.  We  can  see  more  point 
scatter  as  the  cost  coefficients  become  more  varied.  There  is  also  a  general  downward  movement  of  all  points, 
indicating  that  the  average  time  complexity  of  UDPGA*  improves  with  rougher  cost  functions.  We  can 
attribute  each  behavior  to  an  increase  in  the  number  of  deep  local  minima,  and  an  indication  of  bounding 
constraint  effectiveness.  Recall  that  both  algorithms  conduct  crude  initial  A*  search  for  an  initial  solution. 
The  UDPGA*  uses  this  solution  only  to  compute  the  bounding  ellipse  which  can  sometimes  prune  a  large 
amount  of  search  space.  If  the  crude  initial  A*  search  locates  a  deep  local  minimum  then  the  bounding  ellipse 
will  be  tight  The  spreading  of  points  shows  that  some  bounding  ellipses  are  small  enough  to  dramatically 
reduce  the  work  of  UDPGA*.  Path  annealing  can  also  be  improved  with  this  bound.  However,  these 
improvements  are  reflected  more  in  path-annealing  solution  optimality  and  not  so  much  in  CPU  time 
requirements,  which  are  more  sensitive  to  the  annealing  schedule. 
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Figure  5.43      Map5  UDPGA*  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.44     Map5  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.45     Map5  Quadratic  Least-Squares  Curve  Fit:  CPU  Time  vs.  Problem  Size 
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Figure  5.46      Map6  UDPGA*  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.47     Map6  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.48     Map6  Quadratic  Least-Squares  Curve  Fit:  CPU  Time  vs.  Problem  Size 
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Figure  5.49     Map7  UDPGA*  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.50     Map7  Path  Annealing  CPU  Time  Required  vs.  Problem  Size  (in  Edges) 
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Figure  5.51     Map7  Quadratic  Least-Squares  Curve  Fit:  CPU  Time  vs.  Problem  Size 
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The  cost-ratio  vs.  time-ratio  plots  in  Figures  5.52  through  5.54  are  consistent  with  the 
foregoing  discussions  of  optimality  and  time.  We  see  a  general  trend  in  favor  of  the  UDPGA*  algorithm  as 
the  number  of  deep  local  minima  in  the  cost  function  increases  (from  Map5  to  Map7).  However,  note  that  in 
Figure  5.54  for  Map7  there  are  several  very  low  points.  As  implied  earlier,  these  indicate  that  even  UDPGA* 
is  having  trouble  finding  the  true  globally  optimal  path.  To  fix  this  problem,  one  must  decrease  the  value  of 
8  to  increase  resolution.  However,  recall  that  the  CPU  time  requirement  reciprocates  as  the  square.  Yet,  in 
less  time  we  may  be  able  to  run  a  path-annealing  schedule  set  for  more  thorough  local  search,  and  we  may 
also  anneal  from  multiple  starting  solutions. 
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Figure  5.52     Map5  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 
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Figure  5.53     Map6  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 
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Figure  5.54      Map7  Cost  Ratio  vs.  Time  Ratio  (Path  Annealing/UDPGA*) 

e.      Testing  of  a  Difficult  Problem  Instance 

As  a  final  test  of  path  annealing  behavior,  we  have  selected  one  particular  problem  instance 
for  which  path  annealing  appears  to  overlook  the  globally  optimal  path  fairly  often.  This  problem  instance  is 
on  Map6  for  start  point  (15,80)  and  goal  point  (80,50).  The  shortest  midpoint  path-cost  (returned  by  the  initial 
A*  search)  is  239.5  weighted  units,  while  UDPGA*  (at  8=3)  indicates  that  the  optimal  solution  cost  is  186.9 
weighted  units.  Repeated  runs  have  discovered  window  sequences  (WS)  with  locally  optimal  path-cost  values 
throughout  the  range  (186.9.. .239.5). 

We  applied  path  annealing  400  times  on  this  problem  instance.  The  freezing  temperature  (7\), 
reduction  factor  (R),  annealing  chain  length  (L),  and  cutoff  (L  )  values  were  fixed  at  1.0,  0.92,  20,  and  15 
respectively.  We  used  eight  different  starting  temperatures,  and  50  runs  were  conducted  for  each  starting 
temperature.  These  results  are  summarized  in  Figure  5.55.  This  plot  indicates  the  percentage  of  runs  (out  of 
50)  that  path  annealing  returns  the  optimal  path  (cost  =  186.9)  as  a  function  of  the  starting  temperature.  The 
chart  shows  that  for  this  particular  problem  instance,  it  is  more  advantageous  to  begin  annealing  from  a  lower 
starting  temperature.  The  reason  for  this  is  that  the  initial  A*  search  returns  a  midpoint  path  which  represents 
a  high  speed  corridor  containing  the  global  optimum.  Higher  temperatures  allow  the  annealing  process  to 
easily  wander  out  of  this  corridor.  Recall  that  since  Map6  is  very  hilly,  many  relatively  deep  cost-function 
valleys  exist.  Once  out  of  the  corridor  corresponding  to  the  initial  solution,  decreasing  temperature  may 
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prevent  annealing  from  returning  to  it.  In  such  cases,  if  annealing  did  not  discover  the  optimal  solution  while 
inside  this  corridor,  then  it  will  setUe  for  a  non-optimal  solution  within  some  other  corridor. 
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Figure  5.55    Percentage  of  Optimal  Solutions  (out  of  50)  vs.  Starting  Temperature  T 

This  behavior  lends  support  for  the  tunneling  ideas  proposed  in  Chapter  IV,  Section  C.3.C 
Recall  that  the  basic  concept  of  tunneling  is  to  locate  a  set  of  initial  window  sequences  representing  different 
high  speed  corridors,  and  permit  annealing  to  search  each  corridor  more  intensively  by  starting  at  lower 
temperature.  This  method  redirects  the  time  necessary  to  climb  out  of  and  move  between  corridors.  Instead, 
this  time  can  be  devoted  to  more  thorough  searching  of  high  speed  corridors  which  have  the  most  potential 
to  contain  optimal  solutions.  For  this  particular  problem  instance,  Figure  5.56  provides  an  indication  of  the 
wide  range  of  solutions  on  which  path  annealing  can  settle.  This  figure  represents  a  list  of  all  final  solutions 
sorted  by  cost  for  over  400  runs  of  the  path  annealing  algorithm  on  this  problem  instance.  Note  that  even 
though  the  starting  temperatures  vary,  path  annealing  found  the  globally  optimal  solution  (cost  =  186.9)  in 
over  33%  of  these  runs,  and  found  better  solutions  than  initial  A*  (cost  =  239.5)  in  over  75%  of  the  runs. 
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VI.  CONCLUSIONS 

A.      SUMMARY  OF  SIGNIFICANT  RESULTS 

In  this  dissertation  we  have  proposed  a  stochastic  algorithm,  path  annealing,  to  solve  the  weighted- 
region  problem  (WRP),  in  particular,  for  large  complex  problem  instances.  Based  primarily  upon  the 
combinatorial  optimization  technique  known  as  simulated  annealing,  path  annealing  employs  systematic  and 
local  search  in  coordination  to  obtain  good  initial  solutions  that  can  improve  over  time.  Since  the  algorithm 
is  a  local  search  of  complete  solutions,  there  are  more  opportunities  to  establish  and  update  bounds  on  the 
globally  optimal  solution.  Furthermore,  we  have  designed  additional  spatial  constraints  and  heuristic 
enhancements  to  reduce  search  space  and  increase  the  performance  of  path  annealing  to  an  extent  that  it 
becomes  competitive  with  other  approaches  to  the  WRP.  We  have  implemented  and  tested  a  prototype  of  this 
algorithm  on  maps  with  over  300  boundary  edges  and  100  weighted-regions. 

We  believe  that  path  annealing  is  a  practical  approach  to  weighted-region  path  planning  in  a  military 
setting  in  which  region  cost  coefficients  may  model  many  battlefield  parameters.  In  our  review  of  various 
path-planning  implementations,  we  have  seen  evidence  that  large  problems  overwhelm  agenda  mechanisms 
used  by  systematic  techniques  such  as  A*  and  uniform  cost  search.  Our  approach  represents  an  attempt  to 
focus  the  strengths  of  both  local  search  and  systematic  search  to  solve  a  relatively  difficult  problem  in  a 
reasonable  amount  of  time. 

Our  investigation  of  current  algorithm  implementations  reveals  that  grid-based  wavefront  propagation 
appears  to  be  the  only  one  capable  of  handling  the  complexity  of  our  test  maps.  Recall  that  this  algorithm's 
uniform  cost  search  and  resulting  grid-biased  solutions  hamper  both  efficiency  and  solution  accuracy.  In 
order  to  provide  a  faster,  more  accurate  algorithm  to  compete  with  path  annealing,  we  designed  and 
implemented  uniform-discrete-point  global  A*  (UDPGA*)  search.  It  appears  that  this  algorithm  may  also  be 
significant,  since  it  too  is  a  new  approach  for  solving  the  weighted-region  problem  (WRP).  It  represents  a 
wavefront  propagation  approach  which  employs  an  adaptive  grid  that  conforms  to  the  geometry  of  the 
homogeneous-cost  regions,  and  essentially  forms  a  visibility  graph.  With  the  addition  of  the  single-path- 
relaxation  technique  for  finding  the  locally  optimal  path  in  a  window  sequence,  and  a  few  heuristic 
improvements,  UDPGA*  search  often  finds  an  optimal  path  with  very  good  accuracy.  While  empirical 
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execution  times  are  significantly  greater  than  path  annealing,  they  would  quite  likely  be  much  lower  than 
grid-based  wavefront  propagation. 

B.      ALGORITHM  STRENGTHS  AND  WEAKNESSES 

1.      Strengths 

Test  results  indicate  that  for  non-trivial  problem  instances  path  annealing  has  faster  average 
execution  times  than  uniform-discrete-point  global  A*  (UDPGA*)  search.  Also,  the  path-annealing  time 
advantage  appears  to  increase  as  problem  instances  become  larger  in  size.  Both  algorithms  use  Snell's  Law 
to  optimize  within  the  window  sequence  determined  to  contain  the  optimal  path.  Therefore,  compared  to  grid- 
base  wavefront  propagation,  path  annealing  and  UDPGA*  final  solutions  can  be  more  accurate,  since  they 
avoid  the  digital  bias  problem  associated  with  an  orthogonal  grid.  Furthermore,  for  similar  resolutions,  we 
believe  that  the  solutions  found  by  UDPGA*  are  likely  much  closer  to  true  optimal  than  will  be  those  found 
by  wavefront  propagation.  In  this  regard,  path  annealing  solutions  are  also  accurate.  However,  their  nearness 
to  true  optimal  can  be  both  much  worse  and  much  better  than  UDPGA*. 

Significant  advantages  result  from  the  fact  that  path  annealing  examines  only  complete  solutions. 
This  gives  the  algorithm  the  potential  to  discover  and  cache  many  good  routes  between  a  given  start  and  goal. 
Furthermore,  additional  opportunities  occur  to  update  the  upper  bound  on  the  optimal  solution  cost,  which 
controls  the  size  of  the  bounding  ellipse.  Solution  quality  tends  to  improve  over  time  after  the  establishment 
of  the  initial  solution.  In  time-constrained  circumstances,  we  can  abort  path  annealing  prematurely  and  accept 
the  best  known  solution.  This  cannot  be  done  with  systematic  search  techniques  because  they  produce  a  final 
solutions  by  constructing  and  comparing  many  smaller  partial  solutions. 

Since  path  annealing  is  probabilistic,  its  results  are  non-deterministic.  Multiple  runs  of  the  same 
problem  instance  may  return  different  solutions.  Even  if  two  runs  return  identical  solutions,  the  sequence  of 
states  processed  to  reach  those  solutions  are  almost  never  identical.  Therefore,  every  run  has  the  potential  to 
discover  other  good  routes  between  designated  start  and  goal.  This  behavior  can  be  exploited  by  parallel 
execution  on  multiple  processors,  to  which  path  annealing  is  easily  adapted.  Recall  from  Chapter  IV  that  by 
constraining  the  A*  search  in  various  ways,  we  can  force  it  to  locate  several  initial  solutions  corresponding 
to  different  high-speed  corridors.  Since  each  processor  begins  from  a  different  initial  solution,  we  are  able  to 
increase  efficiency  by  annealing  at  lower  starting  temperatures,  and,  at  the  same  time,  we  broaden  coverage 
of  the  search  space. 
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Many  spatial  constraints  and  heuristics  are  available  to  reduce  search  space  and  improve  execution 
times.  Some  of  these  are  annealing-specific,  while  others  are  useful  for  local  search  techniques  which 
examine  complete  solutions.  We  have  also  developed  shortcutting  analysis  and  critical-angle  analysis.  These 
are  general  spatial  constraints  which  can  be  used  by  most  other  weighted-region  problem  algorithms. 

2.      Weaknesses 

Apparently  no  practical  WRP  algorithm  can  provide  an  absolute  guarantee  of  finding  a  globally 
optimal  path.  However,  systematic  approaches  can  effectively  upper  bound  the  error  if  the  optimum  is 
overlooked.  For  example,  the  total  cost  of  an  8-neighbor  grid-based  wavefront  propagation  solution  can  be 
no  more  than  1.08  of  true  optimal  solution  cost.  We  emphasize  that  while  execution  times  can  be  more 
practical,  the  cost  of  a  path  annealing  solution  is  bounded  above  by  a  function  of  the  initial  A*  solution  cost. 
This  represents  a  weaker  upper  bound,  since  this  is  restricted  to  midpoint  paths.  While  improvements  can  be 
made  by  increasing  the  resolution  of  the  initial  A*  search,  tests  on  UDPGA*  indicate  that  execution  times 
will  rise  quite  rapidly. 

To  obtain  good  results  from  path  annealing  requires  some  general  knowledge  of  the  topology  and 
cost  function  of  the  map.  Input  maps  should  have  reasonably  balanced  resolution,  devoid  of  boundary  edges 
which  are  unusually  long  in  relation  to  neighboring  edges.  Regions  should  not  be  extraordinarily  narrow. 
Recall  that  improper  window  sequences  involving  the  multiple  crossing  of  such  edges  and  regions  may  not 
be  reachable  by  the  simple  move  generator  we  have  designed.  A  more  elaborate  move  generator  might 
remove  this  restriction.  However,  this  may  also  increase  the  time  required  to  generate  the  next  window 
sequence. 

Path  annealing  appears  to  work  best  on  maps  with  smoother  cost  functions.  This  comes  as  no 
surprise  since  simulated  annealing  reportedly  performs  best  in  such  search  spaces  [John90].  Hilly  cost 
functions  increase  the  risk  of  prematurely  freezing  the  annealing  process  in  a  bad  local  minimum.  On  the  other 
hand,  hilly  cost  environments  appear  to  require  higher  resolution  of  the  UDPGA*  algorithm  in  order  to  obtain 
solutions  nearer  to  true  optimal.  In  turn,  this  results  in  much  longer  running  times.  Though  the  general 
performance  of  path  annealing  in  such  maps  tends  to  be  worse,  it  can  still  find  a  few  dramatically  better 
solutions  in  less  time. 

Good  algorithm  performance  can  be  sensitive  to  the  annealing  schedule.  There  are  many  ways  to 
establish  good  annealing  schedules.  We  have  suggested  some  primitive  methods  on  the  basis  of  current 
annealing  and  WRP  research.  But,  our  testing  does  not  attempt  to  determine  how  best  to  establish  annealing 
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schedules.  Instead,  we  used  our  own  judgement  based  upon  experience  with  the  test  maps.  However,  in  most 
cases,  establishment  of  an  annealing  schedule  must  be  done  empirically  or  with  some  knowledge  of  the  search 
space. 

Finally,  even  with  the  combination  of  simulated  annealing,  A*  search,  relaxation,  bound 
construction,  and  heuristic  improvements,  the  path  annealing  algorithms  still  only  solves  a  single  problem 
instance  for  a  specific  start/goal  pair. 

3.      Strengths  of  Uniform-Discrete-Point  Global  A*  (UDPGA*)  Search 

We  have  focused  on  the  advantages  and  disadvantages  of  path  annealing.  However,  we  believe 
that  the  uniform-discrete-point  global  A*  search  algorithm  provides  fairly  stiff  competition  for  path 
annealing.  We  reemphasize  that  UDPGA*  search  has  a  few  advantages  of  its  own  over  grid-based  wavefront 
propagation.  Since  it  employs  an  adaptive  grid  similar  to  a  visibility  graph,  it  is  capable  of  more  accurate 
solutions  than  orthogonal-grid-based  wavefront  propagation.  Although  we  have  not  made  direct  comparisons, 
we  conjecture  that  UDPGA*  would  be  generally  faster  than  wavefront  propagation  because  it  is  not  uniform- 
cost  search,  and  therefore  does  not  search  in  simulated  time  increments.  Furthermore,  UDPGA*  preserves  the 
ability  to  adjust  resolution  through  the  establishment  of  edge-points  spaced  at  a  discrete  upper  bound,  8. 
Finally,  unlike  wavefront  propagation,  UDPGA*  actively  searches  and  detects  reentrant-path-containing 
solutions. 

C.      SUGGESTED  FUTURE  DIRECTIONS 

1.      Path  Annealing  Improvements 

Our  primary  focus  in  this  work  has  been  to  establish  that  a  simulated-annealing  approach  to  the 
weighted-region  problem  (WRP)  is  both  feasible  and  practical.  In  designing  a  working  implementation,  we 
took  steps  to  streamline  particular  aspects  of  the  algorithm,  such  as  cost  function  evaluation  and  move 
generation.  In  doing  so,  we  designed  several  methods  for  extracting  performance  improvements  and  we  have 
suggested  several  others.  However,  there  are  surely  other  techniques  for  driving  these  components  which 
might  be  more  efficient  or  more  thorough.  In  particular,  more  sophisticated  move  operators  could  be 
developed  by  relying  more  heavily  on  efficient  random  access  data  structures  (such  as  arrays).  Prolog  dictated 
our  use  of  list-oriented  data  structures. 

The  Snell's-Law  table  lookup  could  also  be  improved.  Recall  from  Chapter  III  that  this  technique 
reduces  ray-tracing  to  constant-time  table  interpolation  for  a  single  crossing  episode,  so  that  an  iterative 
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coordinate  descent  method  (single-path  relaxation)  can  find  the  locally  optimal  path.  The  table  could  be 
extended  to  compute  two  or  more  crossing  episodes.  This  might  increase  the  efficiency  of  single-path 
relaxation,  particularly  for  longer  window  sequences. 

The  spatial  nature  of  the  weighted-region  problem  suggests  that  several  undiscovered  geometric 
heuristics  may  still  exist.  In  particular,  the  idea  of  a  bounding  ellipse  originally  suggested  by  [Rich87]  and 
[Pear84]  appears  to  have  potential.  We  have  improved  the  technique  and  heuristically  extended  its  usefulness 
(e.g.  |i+-ellipse).  However,  there  are  other  interesting  possibilities.  For  example,  some  form  of  crude 
bidirectional  search  might  quickly  ouUine  a  general  elliptical  but  irregular  boundary  which  contains  the  a 
global  optimal  path. 

The  determination  of  good  annealing-schedule  parameter  values  is  another  aspect  of  the  algorithm 
which  may  deserve  more  attention.  However,  recall  that  path  annealing  employs  the  power  of  A*  search  as 
well  as  local  search.  Therefore,  we  believe  that  good  performance  of  path  annealing  may  not  be  as  sensitive 
to  the  annealing  schedule  as  the  need  to  obtain  good  general  coverage  of  the  map.  This  might  be  done  by 
designing  a  more  elaborate  move  generator.  Another  way  is  to  find  a  good  set  of  initial  solutions  to  use  as  a 
basis  for  tunneling  at  lower  annealing  temperatures.  We  have  suggested  that  several  crude  A*  searches  could 
be  used  to  find  this  set.  However,  some  limited  or  modified  algorithm  to  find  the  first  k  shortest  paths  might 
do  this  more  efficiently  [Yen71]. 

If  parallel  processing  is  available,  then  a  horizontal  asynchronous  scheme  for  path  annealing 
would  require  a  set  of  different  starting  solutions.  Each  processor  would  draw  one  initial  solution  out  of  this 
set  from  which  to  begin  annealing  at  a  low  starting  temperature.  Such  a  parallel  scheme  could  proceed  with 
very  little  communication  overhead.  Annealing  can  also  be  parallelized  in  a  vertical  sense.  Move  operator  and 
cost  function  evaluation  algorithms  could  be  redesigned  for  parallel  execution.  The  ideas  for  local 
asynchronous  iterative  parallel  procedures  (LAIPP)  first  proposed  and  implemented  by  [Smit88]  and  later 
implemented  for  a  transputer  by  [Garc89]  have  already  laid  some  of  that  groundwork. 

2.      Extensions  to  Other  Route  Planning  Applications 

In  his  work  on  shortest  paths  in  three-dimensional  space,  [Akma87]  proposed  that  Monte  Carlo 
algorithms  may  constitute  the  only  reasonable  means  of  solving  intractable  path-planning  problems 
associated  with  higher-dimension  space.  We  share  his  belief  that  such  algorithms  are  not  always  appreciated 
by  the  computer  science  community.  Having  demonstrated  the  feasibility  of  a  stochastic  approach  to  the  two- 
dimensional  weighted-region  problem,  a  logical  extension  would  be  to  solve  a  three-dimensional  weighted- 
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volume  problem.  Analogous  to  aspects  of  path  annealing,  the  work  of  [Lewi88]  and  [Rowe89]  attacks  this 
problem.  This  implementation  finds  a  sequence  of  volumes  using  A*  search  through  volume  centroids,  then 
iteratively  improves  the  path  in  a  manner  similar  to  single-path-relaxation.  Follow-on  work  by  [Wren90] 
implements  random  ray-tracing  to  improve  the  A*  solution  paths.  However,  neither  implementation  uses 
stochastic  control. 

In  practical  three-dimensional  route  planning  it  is  often  necessary  to  consider  vehicular 
constraints.  For  example,  shortest  paths  for  high  performance  aircraft  differ  from  those  of  helicopters  because 
of  turning  radius  constraints.  To  account  for  vehicular  direction,  extension  to  a  fourth  dimensional  may  be 
necessary.  Even  without  weighted  volumes,  finding  optimal  paths  through  fields  of  obstacles  in  such  search 
spaces  is  another  problem  for  which  a  simulated  annealing  approach  could  be  valuable. 

Another  interesting  problem  for  which  annealing  might  provide  significant  improvements  is  one 
of  locating  minimal  energy  routes  through  anisotropic  terrain  [Ross89].  Ideas  in  this  w,W, L],ITMP 

i 



% also loads Snell's Law Table 



0 . 001 , 

0 . 001 , 



% WW are weights from weight list 
% W are weights from edge 

% straight-line intersection 

OP) , 



optimal2 (Pi, P2, WW, [V,_,_] , coincide, OP) 

coincident_inter sect ion (PI , P2, WW, 10) , 
endpt_check ( 10, V, OP) , 

I 

optimal2 (_,_, [W0, W0], [V,_,_] , 10, OP) 
endpt_check (10, V,OP) , 

j # 

opt imal2 (PI , P2 , WW, [V, W, L] , 10 , OP) 

match_regions (WW, W, Pi , P2, PW1, PW2) , 

perpendicular (PW2, L, 12) , 

optima 13 (PWl , PW2 , V, W, L, 10, 12, OP) , 

i 



% parallel ==> P1-P2=E 



% phantom edge IO=OP, unless 
% outside edge vertices 

% else, setup table lookup 
% PW* consistent with W 



coincident_intersection (Pi, P2, [Wl, W2] , P2) W1 < W2, !. 

coincident_intersection (Pi, P2, [Wl, W2] , PI) W2 < Wl, !. 

coincident_inter sect ion (Pi , P2 , [W0 , W0 ] , OP) : - midpoint (Pi , P2 , OP) , ! . 



optima 13 (_,_, V,_,_, 10, 12, OP) : - 

vertex_crossing (V, 10, 12, OP) , 

i # 

optima 13 (PWl , PW2 , V, w, L, 10, 12, OP) 
perpendicular (PWl, L, II) , 
snell (PWl, PW2, W, 11,10, 12, OP0) , 
endpt_check (OP0, V, OP) , 

i 
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% ensure point between vertices 



vertex_crossing ( [Vl , V2 ] , 10 , 12, Vl ) : - 

between (10, VI, V2) , 
between (12, Vl, V2) , 

vertex_crossing ( [ Vl, V2 ] , 10 , 12 , V2 ) : - 

between (Vl, V2, 10) , 
between (V1,V2, 12) , 

i 

match_regions (W, W, PI, P2, Pi, P2) . 
match_regions PI, P2, P2, PI) . 

endpt_check (I, [Vl, V2] , V2) between (Vl, V2, I) , !. 

endpt_check (I, [V1,V2] ,V1) between (I, Vl, V2) , !. 

endpt_check (I, ( _, _],l) !. 
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UDP.PL - approximates locally optimal path through a WS using 

Dijkstra's Algorithm through a constrained graph of discrete 
points evenly distributed on each edge with upper bound di; 
used for coarse approximations, and as a preprocessor to 
the more accurate single-path relaxation (SPR) algorithm. 



: - dynamic 

di/1, % di (i) . current discrete interval = i 

epts/3, % epts (eO, di, [pi, . . , pn] ) . edge-points on eO 

pe/2 . % pe (eO, [ [vl, si, pi] , . . , [vn, sn,pn] ] ) . 

% edge-point record eO 

: - use_module (library (lists) , [rev/ 2 ] ) . 

di(8). % default discrete interval 

/* 

dijkstra - path returned is REVERSED with respect to WS edges 
*/ 



dijkstra ([_,_], [SP, GP] , COST) % trivial soln s-g 

start (SP, SR) , 
re (SR, SW,_) , 
goal (GP,_) , 

wdistance (SP, GP, SW, COST) , 

i 

dijkstra ( [EO, El |L] , PATH, COST) :- % ws begins EO = s;g 

start_goal (EO , PO , WO) , 
edge (E1,_,W,_,_) , 
di (INT) , 

epts (El, INT, PTS1) , 

process_routes (WO, [ [PO, 0, 0] ] , PTS1 , PTLSTl) , 
asserta(pe(El, PTLSTl ) ) , 
next_wt (_, WO , W, WN, _) , 

i 

* t 

di jkstra2 ( [El | L] , WN, PATH, COST) , 
w_clear_iter, 

i 



dijkstra2 ( [El,E0] ,_, [PO IPATH] ,D) % ws end EO = s;g 

pe (El, PTLSTl) , 
start_goal (EO, PO, WO) , 

process_routes (WO, PTLSTl, [PO] , [ [P0,D,BG] ] ) , 
back_po inter (PO, [ [PO, D, BG] ] , BP) , 
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w_show_line (PO, BP, 4) , 
retrieve_min_path (BP, PATH) , 

i 

di jkstra2 ( [El, E2, E3 I L] , Wl, PATH, D) % mid ws 

pe (El, PTLST1) , 
edge (E2,_,w,_,_) , 
di (INT) , 

epts (E2, INT, PTS2 ) , 

process_routes (Wl, PTLST1, PTS2 , PTLST2 ) , 
asserta (pe (E2,PTLST2) ) , 
next_wt (E2,W1,W,WN,E3) , 

i 

• / 

di jkst ra2 ( [E2 , E3 I L] , WN, PATH, D) , 

t # 

di jkstra2 (WS, W,_, _) % catastrophic failure 

current (_, WS0,_) , 
retract (next (WS1) ) , 

writeln('WS ERROR (udp) . . . di jkst ra2 failed !'), 

write_list ( [ ' weight : ' , W] ) , 

write_list ([' partial : ' ,WS]), 

write_list ( [ ' current : ' , WSO ] ) , 

write_list ( [ ' next : ' , WS1] ) , 

writeln (' Corrective action ... continuing from current WSO...')/ 

!, fail, ! . 

start_goal (s , P, W) start (P,R), re(R,W,_), !. 

start_goal (g, P, W) goal(P,R), re(R,W,_), !. 

% 

back_pointer (P, [ [P,_, BP] |_] , BP) ! . 

back_pointer (P, [_| L] , BP) back_pointer (P, L, BP) , !. 

ret rieve_min_path (SP, [SP] ) start (SP,_), !. 

retrieve_min_path (GP, [GP] ) goal(GP,_), !. 

ret rieve_min_path (P, [P | PATH] ) 
retract (pe (_,PTLST) ) , 
back__pointer (P, PTLST, BP) , 
w_show_line (P, BP, 4 ) , 
retrieve_min_path (BP, PATH) , 

i 



/* 

process_routes - establishes all routes between an edge-pair; 

Wl = weight of the region separating the edges 

PTLST1 = list of point records [V, S,P] for the "from" edge 

PTS2 = list of points on the "to" edge 

PTLST2 = new list of point-records [V, S,P] for the "to" edge 
min__route finds shortest accumulated distance S and the pointer 
P back to the appropriate "from" edge point-record labeled V. 
*/ 



178 



process_routes (_,_, [],[]) : - ! . 

process_routes (Wl, PTLST1, [ V | L] , [ [V, S,P] | PTLST2 ] ) 
min_route (W1,PTLST1, V,_, [ S , P ] ) , 
process_routes (Wl, PTLST1 , L, PTLST2 ) , 

i 



next_wt (_,W0, [WO, W2 ] , W2 ,_) !. 

next_wt (_,WO, [Wl, WO] , Wl,__) !. 

next^wt (EC,_, chk, WN, EA) % EC choke vertex ==> look ahead at EA 

chr (EC, VC,_) , 
er (EA, RR,_) , 
next_wt2 (RR, VC, WN) , 

i 



next_wt2 ( [Rl,_] , VC, WN) rv (R1 , WN, VLST) , member (VC, VLST) , !. 

next_wt2 ( [_,R2] , VC, WN) rv (R2 , WN, VLST) , member (VC, VLST) , I. 



/* 



min_route - updates the point record [D,P] for point V by computing 
weighted distance from each point in list L (points on the last 

edge in the window sequence) and returning the min total weighted 
distance D and the point P from which it was measured to V. 
*/ 



min_route (_, [] ,_, [D, P] , [D,P] ) ! . 

min_route(W, [ [V,D,_] I L] ,V0, [D0,P0] , [DF , PF] ) 
wdistance (V, VO, W,DV) , 
w_show__line (VO , V, 1 ) , 

DT is D + DV, 

update_point ( [D0,P0] , [DT, V] , [D1,P1] ) , 
min_route (W,L, VO, [D1,P1] , [DF, PF ] ) , 

; 

update_point ( [D,_] , [DT, V] , [DT, V] ) ( var(D) ; DT<D ), !. 

update_point ( [D, P] ,_, [D, P] ) !. 



get_pts - uses a fixed interval (di) to space points uniformly across 
each edge; this interval is an upper bound on the point spacing, 
ie . spacings on some edges may be < di (never greater than) . 
*/ 

epts (E, I, PLST) gen_epts (E, I , PLST) , !. % non-exist ==> generate pe 

gen_epts (E, INT, PLST) : - 
edge (E, V, _,_,_) , 
get_pts (E, V, PLST) , 
assert a (epts (E, INT, PLST) ) , 

i 
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% for subsequent program runs 



reset_points 

retractall (edge_pt (_,_) ) , 
retractall (epts ) , 
asserta ( ( epts (E, I , PLST) gen_epts (E, I , PLST) )), 



getj>ts <_, [V0 f VO] , [VO] ) !. 

get_pts(E, [VI , V2 ] , [NVl | L] ) : - 

edge_data (E, LENG, _) , 

LENG > 0.0, 
di (INT) , 

R_INTS is LENG/ INT, 
ceil (R__INTS , INTS) , 

PART is 0.001/ INTS , 
partition (PART, [VI, V2] , NVl) , 
% w_point (NVl, 3) , 

divisions ( INTS, VI , V2 , L) , 

i 

getjpts (_, [VI, _] , [VI] ) !. 

divisions (INTS, VI, V2, [NV2 ] ) 

INTS =< 1, 

PART is 0.999/ INTS, 
partition (PART, [VI, V2] ,NV2) , 
% w_point (NV2 , 3) , 

! 

divisions (INTS, VI, V2, [P0|L]) 

PART is 1/ INTS, 

partition (PART, [V1,V2],P0), 

% w_point (P0 , 3) , 

NX_INTS is INTS-1, 
divisions (NX_INTS, P0, V2, L) , 



% choke vertex 
% fixed interval size INT 

% in case Vl,V2 too close 

% di(INT) LUB on dist to next point 
% pull in slightly from vertex 

% show point spacing/coverage 
% VI, V2 too close for precision 

% pull in slightly from vertex 
% show point spacing/coverage 

% show point spacing/coverage 



all_epts % generate all edge-points 

edge (E, V, [_,W],_,_) , 

W =\= 0, 
get_pts (E, V, L) , 
fail, 

I 

all_epts ! . 
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PERTURB.PL - move generator; generates random WS transitions 
(vertex/obstacle rotation and reentrant installation) 



: - dynamic 

single_jump/0, % flag to set single rotation 

lock_path_class/0 . % flag to lock between obstacles 



perturb_ws ( [S, G] , WS1) % [s,g] or [g,s] ==> same region 

repeat, % until [S/G] changes 

select_type (TYPE) , 
special_sg_move (TYPE/ [S, G] , WS1) , 

I 

perturb_ws (WSO, WS3) 

length (WSO / LEN) / % compute range 

RANGE is 2*LEN-5, 

repeat/ % until move from WSO is found 

select_edge_which (RANGE, EDGE, WHICH) , 

sp_nthO (EDGE, WSO, EO / Cl, C2) / % NTH edge is EO between C1,C2 

select_type (TYPE) , 

sub_s elect ions ( TYPE/ WHICH/ EO , [Cl,C2, LOC] , ITEM) , 
take_act ion (TYPE, ITEM, LOC, WSO, WS1) , 
cycle_chk (WS1 , WS2 ) , 

f ix_ws (WS2, WS3 ) , % strip out dumb turn edges 

% ws_integrity (WSO, WS, WS1, WS1) , % for debugging only 

i 

select_type (TYPE) : - 
irand (2, X) , 

( X= : =0 -> TYPE=0 % reentrant 

; otherwise -> TYPE=1 ) , % vertex cross 

i 



special_sg_move (0, [S,G], [ S, EO, EO , G] ) 
start (_, R0 ) , 
re (R0, WO, ELST) , 
select (ELST, EO) , 
not (edge (E0,_, [_, 0] ,_,_)) , 

i 

special_sg_move (1, [S, G] , WS1) 
start (_, R0) , 
rv(R0,_, VLST) , 
select (VLST, VO) , 



% special reentrant 



% no border or obstacle edge 
% special vertex cross 
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% cannot jump a border vertex 



border (BRD) , 
not (ovr (VO, BRD) ) , 
ve (VO, VELST) , 
re (RO RELST) , 

set_intersect (RELST, VELST, EE) , 
split_ee (EE, VELST, [S,G] , WS1) , 



set_intersect ( [] , A, (] ) . 
set_intersect ( (A | B] , C, D) : - 
memberchk (A, C) , 

i 

• 9 

D= [ A | E ] , 

set_intersect (B, C, E) . 

set_intersect ( (A | B] , C, D) set_intersect (B, C, D) . 

split_ee ( [El, E2] , VELST, [S , G] ,NEWSEQ) % shift E1,E2 to ends of VELST 

shif t_list (El, VELST, [E1,E | LST] ) , 

( E==E2 -> append ( [E | LST] , [El] , SUB) 

; SUB= (E 1 , E | LST] ), 
irand (2, X) , 

( X=:=0 -> append ( [s I SUB] , [g] , NEWSEQ) % insert SUB between s,g 

; X= : =1 -> append ( [g | SUB] , [s] , NEWSEQ) ), 

i 



% 



select_edge_which (RANGE, EDGE, WHICH) 
irand (RANGE, J) , 

I is J+2, 

EDGE is I//2, 

WHICH is I mod 2, 



% NOT at s or g 
% pick edge 
% lf/rt vertex or fwd/bck region 



sub_se lections (0, WHICH, EO, [C1,C2, LOC] , ER) 
( WHICH= : =0 -> er (EO, [R0,_] ,_) 

; WHICH=:=1 -> er (EO, [_,R0] ,_) ), 

re (R0,_, ELST) , 

( memberchk (Cl, ELST) -> LOC=[Cl,E0] 
; memberchk (C2, ELST) -> LOC=[EO,C2] 
subtract (ELST, LOC, RELST) , 
select (RELST, ER) , 

i 

sub_selections (0,_, E0,_, VO) 
irand(2, WHICH) , 

sub_selections (1, WHICH, E0,_, VO) , 



% reentrant move 
% which region 



) , % failure ==> s or g 

% remove EO and C* 
% select ER from region elist 

% failed reentrant ==> vertex 



sub_select ions ( 1 , WHICH, EO ,_, VO) % vertex move 

( WHICH= : =0 -> edge (EO, [VO, _] ,_,_,_) % select VI or V2 

; WHICH=:=1 -> edge (EO, [_, VO] ,_,_,_) ), 
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% select random ITEM from list L 



select (L, ITEM) 

length (L, LEN) , 
irand ( LEN, X) , 
nthO (X, L, ITEM) , 



sp_nthO(Nl, [ A, B, C | WS] , EO , Cl , C2 ) 

( Nl= : =1 -> E0=B, C1=A, C2=C 
; NO is Nl-1, 

sp_nthO (NO, [B, C|WS] , EO, Cl, C2) ) , 



take_action (0, ER, LOC, WSO, WS1) 

possible_reentrant (ER, LOC, WSO) , 
reentrant_install (ER, LOC, WSO, WS1) , 

I 

take_action ( 1 , VO ,_, WSO , WS1 ) 
single_jump, 
get_elst (V0,ELST) , 
move_ws (WSO, ELST, WS1,_) , 

i 

take_action (1, V0,_, WSO, WS1) 
get_elst (VO, ELST) , 
move_ws (WSO , ELST, WSA, E) , 
second_move (E, VO, WSA, WS1) , 

i 

second_move (null,_, WS, WS) !. 
second_move (E, VO, WSA, WS1) : - 
new_vertex (E, VO, VI) , 
get_elst (VI, ELST2 ) , 
move_ws (WSA, ELST2 , WS1 , _) , 

I 

new_vertex (E, VO, VI) edge (E, [VO , VI ],_,_,_) , ! 

new_vertex (E, VO, VI) edge (E, [VI, VO] , ! 



possible_reent rant (ER, [E1,E2],WS0) 

( ep (El , ER, _, WO , _) ; ep (ER, El , _, WO , _) ), 

( ep(E2,ER,_,W0,_) ; ep (ER, E2,_, WO ,_) ), 
not (consec_reent rants ( [El, El , E2 ] , WSO) ) , 
not (consec reentrants ( [El, E2, E2] , WSO) ) , 



% do NOT select again 



% reentrant 
% legit reetrant path ? 

% single vertex rotation 
% flag for single jumps 



% double vertex rotation 



% exists ? 
% consecutive reentrants 
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cons ec_reent rants ([A,B,C],[A,B,C,D|LIST]) !. 

consec_reentrants (SUBLST, [ A, B, C | LIST] ) 

consec_reentrants (SUBLST, [B, C | LIST] ) , 

t 



reentrant_install (ER, [E1,E2] , [E1,E2 | WS 0 ] , [E1,ER,ER,E2 |WS0] ) ! . 

reent rant_install (ER, LOC, [E3,E4|WS0], [E3,E4|WS1]) 
reent ran t_ins tall (ER, LOC, [E4 | WSO] , [E4 |WS1] ) , 

t 



% 



get_elst (V0,ELST) 
ovr (VO , R) , 

! 

• t 

not (lock_path_class) , 
not (border (R) ) , 
not (ovr (VO, 0) ) , 

( chr (E, V0,_) , che (E, ELST) 

; oe(R, ELST) ), 

i 

get_elst (VO, ELST) ve (VO, ELST), !. 



% if obstacle vertex 

% NO lock on path subclass 
% NO border jumps 
% NO ellipse bound jumps 
% choke vertex 
% regular obstacle vertex 

else non-obstacle vertex 



move_ws (WSO, ELST, WS1,E) 

slice (WSO, ELST, WF, SI, S2, WB) , % extract critical edges 

make_new_seq (ELST, SI, S2, NEWSEQ) , % Sl= [EF, El, Rl] S2= [EB, E2, R2] 

append (WF,NEWSEQ, TEMP) , 
append (TEMP, WB, WS1) , 

( NEWSEQ = [E] 

I NEWSEQ = [] -> E = null 
I otherwise -> select (NEWSEQ, E) ), 



slice (WSO , ELST, WF, SI , S2 , WB) 

extract (WSO, ELST, WF, SI) , % from front of WSO 

rev (WSO , RWSO ) , 

extract (RWSO, ELST, RWB, S2) , % from back of WSO 

rev (RWB, WB) , 



extract ( [A, B, B | WS] , ELST, [A] , [A, B, 1] ) memberchk (B, ELST) , !.% reentrant 

extract ( [A, B I WS] , ELST, [A] , [A, B, 0] ) memberchk (B, ELST) , !. % crossing 

extract ( [A, B | WS] , ELST, [A|WF], [EF, El, R] ) 
extract ( [B | WS] , ELST, WF, [EF, El, R] ) , 

i 



make_new_seq (ELST, [EF,E1,_], [EB, E2,_] , SEQ) : -% shifts El to front 
shif t_list (El, ELST, [_|OLST] ) , 
split_list (OLST, El , E2 , LI, L2) , 
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order_list (EF, EB, El , E2 , LI , L2 , SUB) , 
back_list (EB, E2, SUB, SEQ) , 



back_list (_,_,[],[] ) !. 

back_list (EB, E2 , SUB, NEWSEQ) : - 
last (FB, SUB) , 

( continuous (FB,EB) -> NEWSEQ=SUB 

; cross_continuous (FB, E2, EB) -> append (SUB, [E2] , NEWSEQ) ), 



special__condit ions (_,_, E, E,_) !, fail. 

special_conditions (EF, EB,_,_, F) : - 
continuous (EF, EB) , 
not (continuous (EF, F) ) , 
not (continuous (EB, F) ) , 



order_list (EF,EB,E1,E2, [], [F | ] , []) 

special_conditions (EF, EB, El, E2, F) , 

i 

order_list (EF, EB, El , E2 , [F |_] , [], []) 

spec ial_condit ions (EF, EB, El, E2, F) , 

f 

order_list (EF, EB, El , E2 , LI , L2 , SUB) : - 
f irst_elt (LI, FI) , 
f irst_elt (L2 , F2 ) , 

( continuous (EF, FI) -> SUB=L1 

; continuous (EF, F2 ) -> SUB=L2 

; continuous (El, FI) -> SUB=[E1|L1] 

; continuous (El , F2 ) -> SUB=[E1|L2] 

; rev (LI , RL1) , 
rev (L2 , RL2) , 

order_list (EF, EB, El, E2, RLl, RL2, SUB) ) , 

t 

order_list (EF , EB, El, E2, LI, L2,_) 

writeln_b (' ERROR. . . (perturb) order_list failed ! ' ) , 
writeln_b( [EF, EB, El, E2, LI, L2] ) , 
abort . 

first_elt ( [] , null) . 
f irst_elt ( [F |_] , F) . 

split_list (OLST, El, El, OLST, ROLST) % if E1==E2 (single) 

rev (OLST, ROLST) , 

t b 

split_list (OLST, _, E2 , LI , L2 ) break_list (OLST, E2 , LI , L2 ) ,!. 
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break_list ( [E|OLST] ,E2,L1,L2) 

( E==E2 -> Ll= [ ] , L2=OLST 

; L1=[E|LL], break_list (OLST, E2, LL, L2) ), 



continuous (El, E2) ( ep (El, E2, ; ep (E2, El, ), !. 

cross_continuous (El, E2, E3) % crossing 

(ep (El, E2, Rl,_,_) ; ep(E2,El,Rl,_,_) ) , 

(ep (E2 , E3 , R3 , ; ep (E3, E2, R3,_,_) ) , 
not (same (Rl, R3) ) , 



% 

cycle_chk (WS1 , WS2 ) 

cycle_clear (WS1, WS2) , 

% irand (2 , X) , 

% ( X=:=0 -> all_cycle_clear (WS1, WS2) 

% ; otherwise -> cycle_clear (WS1, WS2) ), 

i 



cycle_clear (WS1, WS2) 
triple (WS1, T) , 

save_f ront (T, WS1 , FRONT, BACK) , 

rev (BACK, RBACK) , 

save_f ront (T, RBACK, RRBACK,_) , 

rev (RRBACK, BAK) , 

close_gap (FRONT, BAK,T,WS2) , 

i 

cycle_clear (WSL, WSL) !. 

triple ([_,_] ,_) fail. 

triple ( [A | L] , A) double (L, A) , !. 

triple ([A|L] ,B) triple (L,B) , !. 

double ([_] ,_) fail. 

double ( [A| L] , A) memberchk (A, L) , !. 

double ( [A | L] , B) double (L,B), !. 

save_f ront (T, [T I WS1 ] , [] , WS1) !. 

save_front (T, [E|WS1] , [E|WS2] ,WSB) save_f ront (T, WS1 , WS2 , WSB) , !. 

close_gap (FRONT, [El | BAK] , T, WS2) 
last (EO, FRONT) , 

( cross_continuous (EO, T, El) -> append (FRONT, [T, El | BAK] , WS2) 

; otherwise -> append (FRONT, [El | BAK] , WS2) ), 

i 



% 
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% removes ALL cycles except reentrants 



all_cycle_clear (WS, WS1 ) 

f ind_f irst_dup (WS, E) , 
remove_cycle ( E , WS , WS 1 ) , 

all_cycle_clear (WS , WS ) !. 

f ind_f irst_dup ( [ ] ,_) fail, 

f ind_f irst_dup ( [A, A | B] , C) not (member (A, B) ) , f ind_f irst_dup (B, C) , !. 

f ind_f irst_dup ( [A | B] , A) member (A, B) , !. 

f ind_f irst_dup ( [A | B] , C) f ind__f irst_dup (B, C) , !. 

remove_cycle (_, [],[]) ! . 

remove_cycle (E, [E | WST] , [E | WS1] ) remove_cycle2 (E, WST, WS1) , ! . 

remove_cycle (E, [El | WST] , [El | WS1 ] ) remove_cycle (E, WST, WS1) , !. 

remove_cycle2 (_, [ ] , [ ] ) % pinch off cycle 

remove_cycle2 (E, [E|WST], [E|WST]) ! . 

remove_cycle2 (E, [El | WST] , WS1) remove_cycle2 (E, WST, WS1 ) , !. 



ws_integrity (WSO , WSC f WS1 , [El, E] ) continuous (E, El ) , !. % end ws 

ws_integrity (WSO , WSC, WS1 , [El, E2, E2 f E3 |WS] ) % reentrant 

(ep(El,E2,R,_,_) ; ep(E2 f El f ) , 

( ep (E2 r E3 , R, f ) , ep (E3 r E2 1 R, ) ) t 

ws_integrity (WSO, WSC r WSl f [E2,E3 |WS] ) , 

I 

ws_integrity (WSO, WSC, WS1, [El, E2, E3 | WS] ) % crossing 

cross_continuous (El , E2, E3) , 
ws_integrity (WSO, WSC, WS1, [E2,E3 |WS] ) , 

ws_integrity (WS0,WSC,WS1, [El, E2 , E3 |_] ) 

write_list ([' ERROR (perturb) ... Invalid WS at ' , [El, E2, E3] ] ) , 
start (S,_) , 
goal (G,_) , 

write_list ([' start =',S,' goal =',G]), 
write_list ( [ 9 WSO =',WS0]), 
write_list ( [' WSC =',WSC]), 
write_list ( [ 9 WS1 =',WS1]), 

writeln (' Taking corrective act ion ... returning to WSO.'), 
fail. 

fix_ws ( [S | WS] ,CW) corrects (S, [S I WS] , CW) , !. 

correct_ws (EO, [El] , [El] ) 

<ep(El,E0,R,_,_) ; ep(E0,El,R,_,_) ) , 

j 

correct_ws (El, [E2 , E2 , E3 | WS ] , Z) 

(ep(El,E2,R,w,_) ; ep(E2,El,R,W,_) ) , 

(ep(E2,E3,R,W,_) / ep(E3,E2,R,W,_) ) , 

( edge(E2,_, [_,W],_,_) -> EN=E2, Z=[E2,E2|CW] 
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% 



strip out 



; otherwise -> EN=E1, Z=CW ) , 
correct_ws (EN, [E3|WS],CW), 

j 

correct_ws (El, [E2 , E2 , E3 | WS ] , CW) % faulty reentrant 

(ep(El,E2,Rl,_,_) ; ep(E2,El,Rl,_,_) ) , 

(ep(E2,E3,R2,_,_) ; ep (E3, E2, R2,_,_) ) , 

correct^ws (El, [E2, E3 | WS] , CW) , 

i 

correct^ws (EO , [El , E2 | WS] , CW) % remove El 

(ep (EO, El, R, , ) ; ep(El / E0 / R / , ) ) , 

(ep (El, E2 , R, , ) t ep (E2, El, R, , ) ) , 

correct_ws (EO, [E2 | WS] , CW) , 

i 

correct^ws (_, [E1,E2 | WS ] , [El |CW] ) 
correct_ws (El, [E2 |WS] , CW) , 

| 

correct_ws (_, WS, CW) : - 

writeln (' ERROR (perturb) ... failed to correct WS !'), 
write_list ( [ ' WS =' ,WS] ) , 
write_list ( [ ' CW = ' , CW] ) , 
fail, ! . 
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B.2 C INTERFACE AND C CODE 



FOREIGN.PL - Prolog to C interface routines 



distance ( [XI, Yl] , [X2,Y2],D) 
distance ( XI, Yl, X2,Y2, D) , !. 

wdistance ( [XI, Yl] , [X2, Y2 ] , W, WD) 
wdistance ( XI, Yl, X2,Y2, W,WD), !. 

snell ( [PX1, PY1] , [PX2,PY2], [W1,W2], 

[ 1X1 , IY1 ] , [ 1X0 , I YO ] , [1X2, IY2], [XOP,YOP]) 
snellc (PX1 , PY1 , PX2,PY2, W1,W2, 

1X1 , IYl , IXO , I YO , 1X2 , IY2 , XOP , YOP ) , !. 

elsearch (D, OW, [SX,SY], [GX, GY] , [V1X,V1Y], [ V2X, V2Y] , D2 , [X,Y],LEN) 

elsearch (D, OW, SX, SY, GX, GY, V1X,V1Y, V2X,V2Y, D2, X, Y, LEN) 

foreign_file (' /n/ai9/work/kindl/sa/lib/heap . o' , [ 

init_heap, 
del_min, 
del_heap, 
ins_heap 
]) . 

foreign_file (' /n/ai9/work/kindl/sa/lib/snells_law . o' , [ 

getable, 
distance, 
wdistance, 
snellc, 
elsearch 
]) . 

foreign_f ile (' /n/ai9/work/kindl/sa/lib/rnd. o' , [ 

irand, 
randinit , 
init__anneal, 
metrop, 
iter_impr, 
total_ws 
]) . 
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/* 

heap 

*/ 



foreign (init_heap, c, init_heap ( [-integer] ) ) . 
foreign (ins_heap, c, ins_heap (-l-float , [-integer] )) . 
f o reign (del_min, c, del_min ( [-integer ])) . 
foreign <del_heap, c, del_heap (4-integer) ) . 



/* 

snellc calls require that getable has been called to load tabledump; 
getable accesses tabledump directly in the current directory 
*/ 



foreign (getable, c, getable ( [-integer] ) ) . 

foreign (distance, c, distance (4-float, +float,+float, +f loat, [-float] ) ) . 
foreign (wdistance, c, 

wdistance (4-float, 4-float, + float, + float , 4-f loat , [-float] ) ) . 
foreign (snellc, c, snellc (4-f loat , +f loat , +f loat , +f loat , 4-f loat , + float , 

+f loat , + float, +f loat , 4-float, 4-float, +f loat, -float, -float) ) . 
foreign (el search, c, el search ( + f loat, 4-f loat, +f loat, +f loat , + float, 4- float, 
+f loat, +f loat, 4-f loat , + float, 4-float , -float, -float, [-float] ) ) . 



/* 

Random generators must NOT be cut ( ! ) ; 
may require re-execution by backtrack, 
randinit calls require access to seed5 
(random digits generated by last run) . 



foreign (irand, c, irand (4-integer , [ -integer] ) ) . 
foreign (randinit, c, randinit ( [-integer] ) ) . 
foreign (init_anneal, c, 

init_anneal (4-float, 4-float, 4-float, 4-integer, 4-integer) ) . 
foreign (metrop, c, metrop (4-float , 4-float , [-integer])) . 
foreign (iter_impr, c, iter_impr (4-float, 4-float, [-integer] ) ) . 
foreign (total_ws, c, total_ws ( [-integer] ) ) . 



/* 

INITIALIZATION 

*/ 



load_foreign_f iles ( [ 

' /n/ai9/work/kindl/sa/lib/heap . o' , 

' /n/ai9/work/kindl/sa/lib/snells_law. o' , 

' /n/ai9/work/kindl/sa/lib/rnd. o' 

] , [' -lm' ] ) , % lm = lib math 

abolish ( [ f oreign_f ile/2 , foreign/3] ) , 

getable (_). % load Snell's Law Table 

% tabledump MUST be in current directory 
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/*= — ======= — === — = — .= — =========================== — 

GLOBAL. C - C definitions - determine table size and range 
======================================================================*/ 



♦include <stdio.h> 

♦include <math.h> 

/* 

if P,Y,R are adjusted, then revise PSIZE, YSIZE, RSIZE for ocp[] [][]»* 
also, remember to recompile with revised global. c 
*/ 



♦define TOLERANCE 0.000001 

♦define PLO 1 
♦define PHI 10 

♦define YLO 0.00 
♦define YHI 1.00 
♦define YINC 0.05 

♦define RLO 0.00 
♦define RHI 10.00 
♦define RINC 0.05 

♦define PSIZE 45 
♦define YSIZE 21 
♦define RSIZE 201 

float ocp[PSIZE] [YSIZE] [RSIZE] , ***ptbl = 0; 

/* NOTE: ptbl=0 ==> table was NOT loaded */ 

int pidx [PHI] [PHI] , **px; 

int i_lim = PHI-PLO+1; 

int j_lim = 1.01 + (YHI-YLO) /YINC; 

int k_lim = 1.01 + (RHI -RLO) /RINC; 

FILE *fp, *f open ( ) ; 

/* */ 
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/ ^ =========================ra============ __ ======================= _ 

SNELLS__LAW . C - table lookup or golden search for Snell's Law crossing 
===================================“=“=““==========“=====“======*/ 



tinclude "global . c" 

/* 

GETABLE - initialize table of x values by loading table core dump 
*/ 



getable ( ) { 

int *pd = & (pidx [ 0 ] [ 0 ] ) ; 
float *oc = & (ocp [0] [0] [0] ) ; 
float **occ = &oc; 

FILE *infile = f open ( "tabledump" , " r" ) ; 

read (f ileno (inf ile) , pidx, sizeof (pidx) ) ; 
read (f ileno (inf ile) , ocp, sizeof (ocp) ) ; 

ptbl = &occ; 
px = &pd; 

return; 



XLOOKUP - linear interpolation into Snell's Law table 

x=f(p,y,r) ==> interpolation of ix=f(i,j,k); table index p is 
obtained indirectly from 2D triangular table indexed by iwl,iw2 
*/ 



double 

xlookup (iwl , iw2 , y, r) 

int iwl,iw2; 
double y, r; 

{ 

int i, j, k; 

double x, jy, kr, r fact or, y factor, dxrl, dxr2, dxl, dx2; 

/* get table index i for appropriate rho = iw2/iwl 
by convention this routine ASSUMES that iw2>iwl ! ! ! */ 

i = pidx [iw2-l ] [ iwl-1 ] ; 
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/* compute indices of square interval for interpolation */ 

jy = (y-YLO) /YINC; kr = ( r-RLO) /RINC; 
j = (int)jy; k = (int)kr;/* safer way to floor */ 

/* compute orthogonal distances from lower corner of square */ 

yfactor = jy- (float) j; rfactor = kr- (float) k; 

/* planar interpolation (or linear in 2 dimensions) */ 

dxrl = ocp [i] [ j] [k+1] - ocp [ i] [ j ] [k] ; 
dxr2 = ocp [i] [ j+1] [k+1] - ocp [i] [ j+1 ] [k] ; 
dxl = ocp[i][j][k] + dxrl * rfactor; 
dx2 = ocp[i] [j+1] [k] + dxr2 * rfactor; 
x = dxl + (dx2-dxl) * yfactor; 

if (ptbl==0) printf ( "WARNING ... Snell' s Law table is NOT loaded !!! \n" ) ; 
return (x) ; 

} /* end XLOOKUP */ 



/* 

WDISTANCE - weighted Euclidean distance between 2 points 
DISTANCE - UNweighted 
WSQRDIST - weighted, squared" 

SQRDIST - UNweighted, squared" 

*/ 



double 

wdistance (xl , yl, x2, y2, w) double xl, yl, x2, y2, w; 

{ return (w * sqrt ( (x2-xl ) * (x2-xl ) + (y2-yl) * (y2-yl ) ) ); } 

double 

distance (xl, yl, x2, y2) double xl, yl, x2, y2; 

{ return ( sqrt ( (x2-xl ) * (x2-xl ) + (y2-yl) * (y2-yl) ) ); } 

double 

sqrdist (xl , yl, x2, y2) double xl,yl,x2,y2; 

{ return ( (x2-xl ) * (x2-xl ) + (y2-yl) * (y2-yl) ); } 



double 

wsqrdist (xl , yl , x2 , y2 , w) double xl , yl , x2 , y2 , w; 

{ return (w*w * ( (x2-xl) * (x2-xl) + (y2-yl ) * (y2-yl ) ) ); ) 
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/* 

GOLDEN - golden ratio search for minimum 
*/ 



#def ine R 0.61803399 
#define C (1.0-R) 

#def ine SHFT (a, b, c, d) (a) = (b) ; (b) = (c) ; (c) = (d) ; 
golden (pxl , pyl , px2, py2 , wl , w2 , vxl , vyl , vx2 , vy2 , xop, yop) 

float pxl , pyl , px2 , py2 , wl, w2, vxl , vyl , vx2, vy2, *xop, *yop; 

f 

float ff,f0,fl,f2,f3; 
float dx, xO , xl , x2 , x3 ; 
float dy f y0 f yl f y2 f y3; 

xO = vxl; yO = vyl; 
x3 = vx2; y3 = vy2 ; 

dx = vx2-vxl; dy = vy2-vyl; 

xl = C*dx+vxl; yl = C*dy+vyl; 
x2 = R*dx+vxl; y2 = R*dy+vyl; 

fl = wdistance (pxl, pyl, xl, yl, wl) + wdistance (px2 , py2 , xl , yl , w2 ) ; 
f2 = wdistance (pxl , pyl , x2 , y2, wl ) + wdistance (px2 , py2 , x2 , y2 , w2 ) ; 

while ( f abs (x3-x0 ) > TOLERANCE* ( fabs (xl ) +fabs (x2 ) ) 

II f abs (y3-y0 ) > TOLERANCE* ( f abs (yl ) +f abs (y2 )) ) { 

if ( f 2 < fl) { 

SHFT (xO,xl,x2,R*xl+C*x3) ; 

SHFT (yO, yl, y2, R*yl+C*y3) ; 

ff = wdistance (pxl, pyl, x2, y2 , wl) + wdistance (px2, py2 , x2 , y2 , w2 ) ; 
SHFT ( f 0 , fl, f2, ff) ; 

} 

else { 

SHFT (x3, x2, xl, R*x2+C*x0) ; 

SHFT (y3, y2 , yl , R*y2+C*y0 ) ; 

ff = wdistance (pxl, pyl, xl, yl, wl) + wdistance (px2 , py2 , xl , yl , w2 ) ; 
SHFT (f3, f2, f 1, ff ) ; 

} 

} 



*xop = 0.5*(xl+x2); 
*yop = 0.5*(yl+y2); 

return; 

) /* end GOLDEN */ 
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/* 

SNELLC - computes Snell's Law crossing point (xop,yop) 
*/ 



snellc (pxl, pyl, px2, py2, wl, w2, ixl, iyl, ixO, iyO, ix2, iy2, xop, yop) 

float pxl, pyl, px2, py2, wl, w2, ixl, iyl, ixO, iyO , ix2, iy2, *xop, *yop; 



{ 



int 

double 



iwl, iw2 ; 
x, xt , y, yt , r, part; 



iwl = nint(wl); iw2 = nint(w2); 



if (iwl == iw2) {/* should NEVER be used, computed in Prolog */ 

*xop = ixO; 

*yop = iyO; 

return(-l); /* -1 = NO computation performed */ 

} 



xt = distance (ixl, iyl, ix2, iy2) ; 
y = distance (pxl, pyl, ixl, iyl) ; 
yt = y + distance (px2, py2, ix2, iy2) ; 

y = y/yt; /* compute normalized y */ 

r = xt/yt; 

if (y>0 . 01 && y<YHI && r>0.01 && r<RHI ) {/* check if in table */ 

if (iwl > iw2) /* check correct orientation */ 

x = 1.0 - xlookup (iw2, iwl, 1 . 0-y, r) ; 

else 

x = xlookup ( iwl, iw2, y, r) ; 

part = x/r; /* optimal partition of edge between il,i2 */ 

*xop = part * (ix2-ixl) + ixl; 

*yop = part * ( iy2-iyl) + iyl; 

return (1); /* 1 = table lookup was performed */ 

} 



else { 

golden (pxl, pyl, px2, py2, wl, w2, ixO, iyO, ix2, iy2, xop, yop) ; 

return(O); /* 0 = golden search was required */ 

} 

} /* end SNELLC */ 
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/* 

ELSEARCH - binary search for intersection of ellipse and line (edge) 
*/ 



float 

elsearch (bestc, ow, sx, sy, gx, gy, xin, yin, xout , yout , cout , xO, yO) 

float bestc , ow, sx, sy, gx f gy, xin, yin, xout, yout, cout, *x0, *y0 ; 

{ 

float x, y, c, xl, yl, tol=0 . 001; 

xl=xin; yl=yin; 
c=cout ; 

while (f abs (c-bestc) > tol) { 

x = 0 . 5* (xin+xout ) ; 
y = 0 . 5* (yin+yout ) ; 

c = wdistance (sx, sy, x, y, ow) + wdistance (gx, gy, x, y, ow) ; 

if (c > bestc) { xout = x; yout = y; ) 
else { xin - x; yin = y; ) 

) 

*x0=x; *y0=y; 

return ( distance (xl , yl , x, y) ); /* new length of edge */ 

) /* END elsearch */ 
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/* ====================================================================== 

RND.C - annealing primitives and random number generation routines 



# include <stdio . h> 

#include <math.h> 

#include "statel.h" /* random list of numbers */ 

#def ine DIGIT 4 

fdefine MAXINT 0x7FFFFFFF 

FILE *fp, *fopen(); /* file pointers for seed5 */ 

unsigned seed = 1; 

float fmaxint = ( float ) MAXINT ; 

/* 

Annealing parameters (global) : 

Define change in cost function as: dc = c[i] - c[i+l] 

Then dc > 0.0 implies cost improvement, accept at p = 1.0 
and dc < 0.0 implies cost degradation, accept at p = exp(dc/t) 
Thus, function metrop(dc,t) should operate as follows: 

return ( (dc >=0.0) || (randOlO < exp(dc/t)) ? 1:0 ) 

*/ 



float tfactor; 
float temp; 
float tfrozen; 



/* temp reduction factor (eg .9)*/ 
/* current temperature*/ 
/* current temperature*/ 



int n total = 0; 



/* total attempted moves all t*/ 



/* The following stats are accumulated at each temperature temp*/ 



int n_limit; 
int ns_limit; 
int n = 0; 
int ns = 0; 



/* max attempted moves (eg 100)*/ 
/* max successful moves (eg 10)*/ 
/* attempted moves*/ 
/* successful moves*/ 



int n_imp = 0 ; 



/* attempted moves @ dc >= 0.0*/ 
/* n_deg = n - n_imp* / 



float sum_dc_deg =0.0; /* sum of dc degrading*/ 

float mean_dc_deg; /* <dc degrading> = exp val dc-*/ 



float sum_c = 0.0; 
float ss = 0.0; 
float mean; 
float sd; 



/* sum of c*/ 
/* sum of c~2*/ 
/* <c> = expected value c*/ 
/* std deviation of c*/ 
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/* 

IRAND (K) - generate random integer in range [0..K) 

*/ 



int 

irand(k) int k; { 

if (k>0) return ( random ( ) % k) ; 

else print f ("ERROR. .. attempt to call irand(k) for k<-0\n") ; 

} /* END irand */ 

/* 

INITSEED ( ) - generate a new seed from the system clock 
*/ 



unsigned 
initseedO { 

unsigned t, curtime, loctime, save, oldsave; 



/* 

MUST call time(O) (ie. arg = NIL pointer) to ensure that time 
does NOT store return structure on top of program variable space. 

*/ 

curtime = (unsigned) time ( 0 ) ; /* no of seconds since 1 Jan 1970 */ 

if (fp = f open ( "seed5" , "r" ) ) { 

fscanf (fp, "%d" , & oldsave) ; 
f close (fp) ; 

} 

else 

oldsave = 2311; /* some large prime number */ 

t = (unsigned) explO ( (float) DIGIT) ; 

loctime = curtime % t; /* last DIGIT digits */ 

seed = loctime*oldsave + loctime + 13; 

save = seed % t; /* last DIGIT digits */ 

fp = f open ("seedS", "w") ; 
f print f (fp, "%d" , save) ; 
fclose (fp) ; 

print f (" \ncurtime = %12d\n", curtime) ; 
printf ( "loctime = % 12d\n" , loctime) ; 
printf ( "t = %12d\n",t); 
printf ( "oldsave = % 12d\n" , oldsave) ; 
printf ( " (new) save = % 12d\n" , save) ; 
printf ( "seed = % 12d\n\n" , seed) ; 

return (seed) ; 

} /* END initseed */ 
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/* 

RANDINITO - initialize new random seed and statel for random() 
*/ 



unsigned 
randinit ( ) { 

int n = 256; /* total no. bytes in statel = 4*64 */ 

initseedO; /* to change seed */ 

initstate (seed, statel, n) ; /* to initiate state with seed */ 

setstate ( statel ) ; /* to use statel */ 

/* srandom(l) ; /* generates SAME sequence each execution */ 

srandom (seed) ; /* generates NEW sequence each execution */ 

return (seed) ; 

} /* END randinit */ 

/* 

GENSTATEO - generate a new statel 

*/ 



genstateO { 

int i, size = 64; 
randinit ( ) ; 

fp = fopen ("statel .h”, "w") ; 

fprintf (fp, "static long statel [64] = {\n"); 

for (i=l; i<size; i++) 
fprintf (fp, "%15d, \n" , irand ( 1000000000 ) ) ; 

fprintf (fp, "%15d } ; \n", irand (1000000000) ) ; 
fclose (fp) ; 

} /* END genstate */ 

/* 

rand01() - uses random ( ) to generate random number on [0,1) 
*/ 



float 
randOl ( ) 

{ return ( ( float ) random ( ) / fmaxint ); ) 

/* to extend range returned by randOl, use this call: 
return (( float ) random ( ) / (float ) 0x7FFFFFFF * range); */ 
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ANNEAL. C - simulated annealing control routines and statistics 



/* 

init_anneal ( ) - initialize annealing parameters 

*/ 



init_anneal (ts,tO,tfac,nO,nsO) 

float ts, tO, tfac; 
int nO, nsO; 

{ 

temp = ts; 
t frozen = tO; 
tfactor = tfac; 
n__limit = nO; 
ns_limit = nsO; 
n = 0 ; 
ns = 0; 
n_total = 0; 

printf ( "\n" ) ; 

printf (" starting temp = %8 . 2f \n", ts) ; 

printf (" freezing temp = %8 . 2f \n" , t 0 ) ; 

printf (” temp reduction factor = %8 . 2f \n u , tfac) ; 

printf ("max perturbations per temp = %8d\n",n0); 

printf (" max successes per temp = %8d\n" , nsO ) ; 

printf ("\n") ; 

printf (" temp n ns dc+ dc- <dc-> <c> sd cum\n" ) ; 

printf (" ") ; 

printf ("\n") ; 

)/* END init_anneal */ 

/* 

cool() - reduce the temperature (temp) per annealing schedule; 
may be modified for more elaborate cooling schemes 
*/ 



cool() { 

int den; 

den = n - n_imp; 

if (den == 0) mean_dc_deg = 0.0; 
else mean_dc_deg = sum_dc_deg/ (float ) den; 
sum_dc_deg = 0.0; 
mean = sum_c/ (float ) n; 

sd = sqrt ( (ss/ (float ) (n-1 ))- (mean*sum_c/ (float ) (n-1 ) ) ); 

sum c = 0.0; 
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ss = 0.0; 



n_total = n_total + n; 

print f ( " %7 . If %3d %3d %3d %3d %8.1f %7.1f %7.1f %4d\n", 

temp, n, ns, n_imp, n-n_imp, mean_dc_deg, mean, sd, n_total) ; 

temp = tfactor * temp; 
n = 0 ; 
n_imp = 0 ; 

if (ns == 0 | | temp <= tfrozen) { 

printf(" freezing temp = % 8 . 2f \n" , temp) ; 

printf ("total perturbations evaluated = %8d\n" , n_total) ; 
return (0); /* HALT - effectively frozen */ 

} 

else { 
ns = 0; 

return (1); /* continue annealing */ 

> 

) /* END cool */ 

/* 

metrop (cl, c2 ) - returns 1-accept / 0-re ject or -1 if frozen 

cl = current cost; c2 = new cost; 

*/ 



metrop (cl, c2) float cl,c2; { 

int determ; /* determinant = accept 1 or reject 0 */ 

int improve; /* 1 if dc non-negative */ 

float dc; 

dc = cl-c2; 
n++; 

sum_c = sum_c + c2; 

ss = ss + ( c2*c2 ) ; 

improve = (dc > 0.0) ? 1:0; 

if (improve) n_imp++; /* n_deg = n - n_imp */ 

else sum_dc_deg = sum_dc_deg + dc; 

determ = ( improve I | (randOlO < exp (dc/ temp) ) ) ? 1:0; 

ns = ns + determ; 

if (n >= n__limit | | ns >= ns_limit) { 
if (coolO) return (determ) ; /* continue annealing */ 

else { n=0; return (-1); ) /* HALT - effectively frozen */ 

) 

return (determ) ; 

) /* END metrop */ 
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/* 

iter_impr (cl, c2) - iterative improvement; returns 1-improves/O-re ject 
cl = current cost; c2 = new cost; 

*/ 



iter_impr (cl f c2 ) float cl,c2; { 
n++; 

if (n <= n_limit) return ( (cl-c2 >= 0.0) ? 1:0 ); 

else { n=0; return (-1); } 

) /* END iter_impr */ 

/* 

total_ws() - returns total number of window sequences evaluated 
*/ 



total ws() { return (n total); ) 
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/*====================================================================== 

HEAP . C - routines to operate a heap data structure 

================= , ======== _ ===== , ==================================e= */ 



#include <math.h> 

#def ine NULL 0 

#def ine MAXHEAP 100000 

struct heap__item { int cost, hash; }; 

struct heap_item heap [MAXHEAP] ; 

int i, hashcount = 0, heap_size = 0; 

/* 

INIT_HEAP 

*/ 



init_heap() { 

heap__size = 0; 
hashcount = 0; 
for (i=0;i<MAXHEAP;i++) { 
heap[i] .cost = -1; 
heap[i].hash = -1; 

} ; 

} /* END INIT_HEAP */ 

/* 

SIFT_UP - heap routine 

*/ 



sift_up(k) int k; { 
int parent; 
if (k > heap__size) 

print f ( "ERROR ... Attempted to sift__up an element not in heap! \n") ; 
while (k > 1) { 

parent = floor ( (double) k/ (double) 2) ; 
if (heap [parent ]. cost > heap [k] . cost ) { 

interchange (parent, k) ; 
k = parent; 

1 

else return (NULL) ; 

1 ; 



) /* end SIFT UP */ 
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/* 

INS_HEAP - insert into heap 

*/ 



ins_heap (cost ) int cost; { 

int hash; 

hashcount++; 
heap_size++; 
hash = hashcount; 

if (heap_size >= MAXHEAP) 
printf ( "ERROR. . . Over-extended heap ! " ) ; 

heap [heap_size] .hash = hash; 
heap [heap_size] . cost = cost; 
if (heap_size > 1) sif t_up (heap_size) ; 
return (hash) ; 

} /* END INS_HEAP */ 

/* 

SIFT_DOWN - heap routine 

*/ 



sift_down(k) int k; { 
int j; 

if (k > heap_size+l) { /* k might be the old last element */ 

printf ("ERROR. . .Attempted to sift_down element not in the heap!\n"); 
printf ("k = %d heap_size = %d\n" , k, heap_size) ; 

} 

do { 
j = k; 

if ( 2 * j <= heap_size S& heap [2 * j ] . cost < heap [k] . cost) 
k = 2 * j ; 

if (2*j < heap_size && heap[2* j+1] .cost < heap [k] . cost) 
k = 2* j+1; 
interchange (k, j) ; 

) while ( j ! = k ) ; 

) /* end SIFT DOWN */ 



204 



/* 

DEL__MIN - returns top of heap (minimum) and restores heap property 
*/ 



del_min() { 

int root; 

if (heap_size > 0) { 

root = heap[l] .hash; 
interchange (1, heap_size) ; 
heap [heap_size] .hash = NULL; 
heap [heap_size] . cost = NULL; 
heap_size — ; 

if (heap_size > 1) sif t_down ( 1 ) ; 
return (root) ; 

} 



else { 

printf ("ERROR. . .Attempt to delete from empty heap!\n"); 
return (NULL) ; 

} ; 



) /* end DEL_MIN */ 

/* 

DEL_HEAP - delete from anywhere in heap; requires linear search 
*/ 



del_heap(k) int k; { 
int i = 1 ; 

if (heap_size > 0) { 

while ( (heap [i] .hash != k) && (i < heap_size) ) i++; 
interchange (i/ heap__size) ; 
heap [heap_size] .hash = NULL; 
heap [heap_size] . cost = NULL; 

heap_size — ; /* heap [heap_size ] is now last element */ 

if (heap_size > 1) sif t_down (i) ; 

} 

else print f ( "ERROR. . .Attempt to delete from empty heap!\n"); 

} /* end DEL HEAP */ 



205 



/* 

INTERCHANGE - swap elements in heap 

*/ 



interchange (parent , child) int parent , child; { 

struct heap_item hold; 

hold = heap [parent ] ; 
heap [parent] = heap [child] ; 
heap [child] = hold; 

} /* end INTERCHANGE */ 
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TABLE. C - table generation, read, dump, get routine 
#include "global. c" 

/* 

GENTABLE . C - generate Snell's Law lookup table for crossing episodes 
*/ 



gentableO { 

float vl,v2, r,p0,p,x,y,el,e2; 
int i, j , k, m, n, i_lim; 

fp = fopen ("sldataO", "w") ; 

i_lim = PHI-PLO+1; 
i lim = (i lim*i lim - i lim)/2; 



for (m=PLO-l; m<PHI; m++) 
for (n=PLO-l; n<m; n + + ) { 

pO = (f loat) (m+1) / (float) (n+1) ; 
i++ ; 

pidx [m] [n] = i; 

fprintf (fp, ,f %d\n", pidx [m] [n] ) ; 
for ( j = 0 ; j<j_lim; j++) { 

y = (float) j*YINC+YLO; 

for (k=0; k<k_lim; k++) { 

r = (float) k*RINC+RLO; 

vl = 0.0; v2 - r; 
el = 1.0; e2 = 1.0; 

while (el>TOLERANCE && e2>TOLERANCE) { 
x = 0.5* ( vl+v2 ) ; 

p = cos (atan (y/x) ) /cos (atan ( ( 1 . 0-y) / ( r-x) ) ) ; 

if (p<p0) vl = x; 

else v2 = x; 

el = f abs (pO-p) ; 

e2 = fabs (v2-vl) ; 

) /* end while */ 
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fprintf (fp, " %8 . 6f \n" , x) ; 
f flush ( fp) ; 



} /* end for */ 

) /* end for */ 

} /* end for */ 

fclose (fp) ; 

) /* end GENTABLE */ 

/* 

READTABLE . C - read table in ascii format (sldataO) 
*/ 



readtableO { 

int m, n, i, j , k; 

ptbl = (float ***) malloc ( (unsigned) j__lim*k__lim*sizeof (float **) ) ; 
px = (int**) malloc ( (unsigned) (PHI-PLO+1 ) *sizeof (int * ) ) ; 

fp = f open ( "sldataO" , "r" ) ; 

printf ( "Loading Snell's Law table... "); 

f flush (stdout ) ; 

for (m=PLO-l; m<PHI; m++) { 

for (n=PLO-l; n<m; n++) { 

f scanf ( fp, "%d" , &pidx [m] [n] ) ; 
i = pidx [m] [n] ; 
for ( j = 0 ; j< j__lim; j++) 
for (k=0; k<k_lim; k++) 

fscanf (fp, ”%f " , & ocp [i] [ j] [k] ) ; 

} 

printf ("%d ’^m+l) ; 
f flush (stdout) ; 

} 

printf (” . . .done . \n u ) ; 
f flush (stdout) ; 
fclose (fp) ; 
return ; 

} /* end READTABLE */ 
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/* 

DUMPTABLE . C - read ' sldata' in ascii, dump core image to ' tabledump' 
*/ 



dumptableO { 

FILE *outfile = f open ( " tabledumpO M , ” w" ) ; 

readtableO; /* requires table in ascii form (sldataO) */ 

write ( f ileno (out file) , pidx, sizeof (pidx) ) ; 
write (f ileno (outf ile) , ocp, sizeof (ocp) ) ; 
f flush (outf ile) ; 
return; 

} /* end DUMPTABLE */ 

/* 

GETABLE . C - reads core dump of table (tabledump) 
*/ 



getableO { 

int *pd = & (pidx [0] [0] ) ; 
float *oc = & (ocp [0] [0] [0] ) ; 
float **occ = &oc; 

FILE *infile = f open ( "tabledumpO ", "r" ) ; 

read ( f ileno (infile) , pidx, sizeof (pidx) ) ; 
read ( f ileno ( inf ile) , ocp, sizeof (ocp) ) ; 

ptbl - &occ; 
px = &pd; 
return; 

} /* end GETABLE */ 



/* */ 

main() { 

gentableO; /* generate sldataO (ascii) */ 

dumptableO; /* execute readtableO and dump tabledumpO (binary) */ 

getableO; /* load to check for correctness */ 



) /* END main */ 
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B.3 UTILITIES AND PRIMITIVES 



/ft-......—-————————————-—, 

PROLOG.INI - makes custom version of Quintus Prolog 



Run Quintus Prolog in your root with this file called prolog.ini and 
your regular prolog.ini file renamed to init.pl. After you receive 
the normal Q-Prolog opening message and prompt, enter ' make (name) . ' 
to save the state in executable form as 'name'. Henceforth, you must 
start Quintus Prolog by entering 'name' in Unix. This will rapidly 
load compiled versions of all libraries requested below, and give you 
the prolog prompt . 



*/ 



compile (' lib/init' ) , % contains root and xload definitions 

use_module (library (math) , all) , % append, member , memberchk, nonmember 
use_module (library (basics) , all) , 
use_module (library (lists) , [ 
last/2, 
rev/2, 
is_list/l, 
nthO/3, 
nthl/3, 
delete/3 ] ) , 

use_module (library (sets) , [subtract/ 3, subset /2] ) , 
use_module (library (strings) , [concat/3, concat_atom/3] ) , 
use_module (library (files) , [ f ile_exists/l ] ) , 
use_module (library (ctypes) , [is_endf ile/1] ) , 
use_module (library (dialog) ) , 
use_module (library (interpret_messages) ) , 
use_module (library (messages ) ) , 

xload ( ' lib/util' ) , 
xload ( ' lib/ line' ) , 
xload ( ' lib/pwin' ) , 
xload ( ' lib/pre' ) , 
xload(' lib/ellipse' ) , 
xload (' lib/udp' ) , 
xload (' lib/ optimal' ) , 
xload ( ' lib/spr ' ) , 
xload ( ' lib/ foreign' ) , 
xload ( ' lib/st art ' ) , 
xload ( ' lib/mouse' ) , 
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xload ( ' lib/stats' ) 



nl, writeln (' Enter ''make(P).'' to create executable ''P''.'). 
make(P) : - 

save(P,l), % remaining statements execute at start-up of P 

nl, 

writeln (' Q-Prolog Rel 2.5 (SPARC) ... custom vers 5 Nov 90'). 
make(P) : - 

nl, write (' Created custom vers of Q-Prolog: '), 
writeln (P) , 
halt . 

make_exec(P) save(P,l), background, 

make^exec (_) halt. 

background f ile___exists ( ' run . pi' ) , compile ( run) . % background 
background start. % interactive 
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/*===================================================„================= 

INIT.PL - primitive routines 

======================================================“==============*/ 



/* 

Library pointers and file manipulation 
*/ 



libra ry_di rectory (' / us r / loca 1/quint us /gene ric/qplib2 . 5/ library' ) . 
library_di rectory ( ' /usr /local /quint us /pwl . 1/ library' ) . 

root (' /n/ai9/work/kindl/sa/ ' ) . 

xconsult (F) f ilepath (F, PATH) , consult (PATH) . 

xload(F) : - f ilepath (F, PATH) , ensure_loaded (PATH) . 

f ilepath (F, PATH) 
root (D) , 

name (D, LI) , name (F, L2) , 
append (LI, L2, L) , 
name (PATH, L) . 



/* 

Primitives 

*/ 



not (X) : - \+ X . 

% unknown (X, fail) . % call to unknown predicate simply fails 

% unknown (X, trace) . % (default) trap to debugger 

% append ( [ ] , L, L) . 

% append ( [X | L] , R, [X | List ] ) : - append (L, R, List ) . 

sys (STRING) unix (system (STRING) ) . 

writeln(X) write (X) , nl . 
writelnln(X) write (X) , nl, nl. 
writeln(S,X) write(S,X), nl(S). 
writelnln (S , X) write(S,X), nl(S), nl(S). 

writeln_b(X) bold, write (X) , nl, alloff, !. 

write_list ( [ ] ) nl, !. 

write__list ( [X | L] ) write (X) , write (' '), write_list (L) , !. 

write_list_b (X) bold, write_list (X) , alloff, !. 
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same (X, X) . 



% clearscreen or page 
% shorthand code 



els display ( ' A L' ) . 
nt notrace, 

ns nospyall. 

1 (X) : - listing (X) . 

dump(P) % dump listing of predicate to file 

open (P, write, S) , 
tell (S) , 
listing (P) , 
told. 



/* 

Enhancements to On-Line Help / Manual 
*/ 



man manual. 

m : - manual. 
m(X) manual (X) . 

m (S, N) sect ( S , SEC) , manual (- (SEC, N) ) . 
m ( S , N, P ) sect ( S, SEC) , manual (-(- (SEC, N) , P) ) . 

m(S,N,P,Q) sect(S,SEC), manual (-(-(-( SEC, N) , P ), Q) ) . 

sect (u, user ) . 
sect ( r, ref) . 
sect ( s, sysdep) . 
sect (1, lib) . 
sect (p, pw) . 

h (X) 

name (X, L) , 
char_list (L,CL) , 
append ( [m] ,CL,MLIST) , 

M = . . MLIST, 
call (M) , 

i # 

h (_) : - 

writeln ( ' ERROR. . . Invalid use of h (X) . . . 9 ) , 

writeln(' X must be form of 9 9 sd' ' , 9 9 sdd' ' , or ' 9 sddd ' ' 9 ) , 

writeln(' s = u(user), r(ref), s(sys), or 1 (lib) 9 ) , 
writeln ( ' d = digit 0..9 [if d>9, use form m(s,d,d,d) ] ' ) . 

char_list ( [] , [] ) . 
char_list ( [N | L] , [C | CL] ) : - 

name (C, [N] ) , 
char_list (L, CL) . 
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VT-100 Terminal escape sequences 



eb esc, lbrack. 


% 


escape, left bracket 


clear eb, two, uj. 




% clear screen 


home eb, uh. 




% home cursor 


reverse eb, ques, five, lh. 




% reverse screen 


normal eb, ques, five, 11. 




% normal screen 


smooth eb, ques, four, lh . 




% smooth scroll 


scr_norm eb, ques, four, 11. 




% normal scroll 


backup esc, urn. 




% reverse index 


save cur esc, seven. 






rest_cur esc, eight. 

cur ( L, C) esc, uy, write(L), write (C) . 






alloff eb, zero, lm. 


% turn off all attributes 


bold eb, one, lm. 




% bold attrib 


under eb, four, lm. 




% underline attrib 


blink eb, five, lm. 




% blinking attrib 


rvideo eb, seven, lm. 


% 


reverse video attrib 



/ * 

ASCII display codes (used above) 

*/ 



esc : 


- put (27) . 


% escape 


zero 


: - put (48) . 


% numerical digits 


one : 


- put (49). 




two : 


- put (50 ) . 




three 


: - put (51) . 




four 


: - put (52 ) . 




five 


: - put (53) . 




six : 


- put (54) . 




seven 


: - put (55) . 




eight 


: - put (56) . 




nine 


: - put (57 ) . 




ques 


put (63) . 


% ? 


lbrack : - put ( 91) . 


% [ 


la : - 


put ( 97 ) . 


% lowercase alpha 


lh : - 


put (10 4) . 




11 : - 


put (10 8) . 




lm : - 


put (10 9) . 




uh : - 


put (72) . 


% uppercase alpha 


uj : - 


put (74 ) . 




um : - 


put (77) . 




uy 


put (89). 
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UTIL.PL 






irandom(A, B, IR) % random integer range A..B inclusive 

RNG is B-A+l, 
irand (RNG, N) , 

IR is N+A, 



/* 

timing - CPU sec 

*/ 

timestart stat ist ics ( runt ime, _) , !. 

timemark (TIME) 

stat istics (runtime, [_, T]), 

% format ('-3d sec CPU time-n' , [T] ) , 

TIME is T/1000, 

i 

ts timestart. 

tm : - timemark (_) . 
tm(T) timemark(T). 

/* 

tolerance - between a pair of points 

*/ 

dynamic tolerance/1. 

tolerance (0 . 000001 ) . % default tolerance, change with asserta 

with intolerance ( [ [XI, Yl] , [X2, Y2] ] ) : - 

abs_d iff (Xi,X2,DX) , abs_d if ^ f ( Yi , Y2 , DY) , 
tolerance (Spec) , 

!, % do NOT get another tolerance Spec */ 

DX < Spec, DY < Spec. 

abs_d iff (XI, X2, AD) Xl=<X2, AD is X2-X1, !. 

abs_d iff (Xi, X2, AD) AD is X1-X2, !. 
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/* 

Constants /Conversions 

*/ 



pi (3.14159) . 
half_pi ( 1 . 5708 ) . 

rad_deg(R,D) 

not (var(R) ) , var (D) , 

D is R*180. 0/3. 14159, 

j # 

rad_deg(R,D) 

var (R) , not (var (D) ) , 

R is D*3. 14159/180.0, 

I 

rad_deg(_,_) writeln (' ERROR (ut il) . . . rad_deg needs a constant/) , !. 

/* 

absolute - prolog type-independent absolute value 
*/ 



absolute (X,X) X>=0, !. 

absolute (X, AX) AX is -X, !. 

/* 

miscellaneous routines - common to table lookup and search 
*/ 



between ( [XI, Y1 ] , [XM, YM] , [X2 , Y2 ] ) 
number__be tween (XI, XM, X2) , 
number_be tween (Yl, YM, Y2) , 

j 

number_be tween ( A, B, C) A=<B, B=<C, !. 

number_be tween (A, B, C) A>=B, B>=C, !. 

number_be tween (A, B, C) : - 
close__enough (A, B) , 
close_enough (B, C) , 

i 

close_enough (N1 , N2 ) 

D is N1-N2 , 
fabs (D, AD) , 

AD<0 . 0001, 

! 



wtd_jpath (P1,P2, [W1 , W2] , P, C) 
wdi stance (PI, P, Wl, Cl) , 
wdi stance (P2, P, W2 , C2) , 
C is C1+C2, 
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/* 

closest - determines which of {P1,P2} closest to ref point PR 
*/ 



closest (PR, PI, P2, PC) 

sqr_dist (PR, PI, SD1 ) , 
sqr_dist (PR, P2, SD2 ) , 
nearer (PI, SD1, P2, SD2, PC) , 

i 

sqr_dist ( [XI, Yl] , [X2, Y2) , SD) 

DY is Y2-Y1, DX is X2-X1, 

SD is DX*DX + DY*DY, 

i 

nearer (Pi, SD1,_, SD2, Pi) SD1=<SD2, !. 

nearer (_,_, P2,_, P2) !. 
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/* =======================ss======= _ ===================================== 

LINE.PL - geometric routines 

======================================================================*/ 



ensure__loaded (library (math) ) , 
xload (' lib/util' ) . 

intersect (Pl,P2,P3,P4,I) : - 

line (PI, P2, ABC) , 
line (P3, P4,DEF) , 
intersection (ABC, DEF, I) , 



line ( [X, Y] , [X, Y] , [0, 0, 0] ) % degenerate line = point 

write_list ([' WARNING (line) ... degenerate line at',[X,Y]]), 

i 

line ( [X,_] , [X,_] , [ 1 . 0 , 0 . 0 , X] ) :- !. % infinite slope line = vertical 

line ( [_, Y] , [_, Y] , [ 0 . 0 , 1 . 0 , Y] ) !. % zero slope line = horizontal 

line ( [XI, Yl] , [X2, Y2 ] , [A,B,C] ) 

DX is X2-X1 , 

line2 (DX, [XI, Yl] , [X2, Y2] , [A,B,C] ) , 

! 

Iine2 (DX, [Xl,_] , [X2,_] , [1.0,0.0,XM] ) % near vertical 

fabs (DX, ADX) , 

ADX < 0 .001, 

XM is 0.5* (X1+X2) , 

i 

line2 (DX, [XI, Yl] , [X2 , Y2] , [A, 1 . 0, C] ) 

A is (Y1-Y2) /DX, 

C is (Y1*X2-Y2*X1) /DX, 

i 



/* 

INTERSECTION CONDITIONS: 

DEN = B*D-A*E = 0 AND B*F-C*E = 0 
==> coincident or degenerate lines 

DEN = B*D-A*E = 0 AND B*F-C*E /= 0 
==> parallel lines 

*/ 



intersection ( [A, B, C] , [D,E,F],I) 

DEN is B*D-A*E, 

intersect ion2 (DEN, [A,B,C], [D, E, F] , I) , 
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intersection^ (DEN, [A, B, C] coincide) 

DEN =:= 0.0, % DEN requires explicit zero check 

% write_list ( ['WARNING ( line) ... coincident lines L =' , [A, B, C] ] ) , 

i 

intersection2 (DEN, [A,B,C], [D, E, F] , [X,Y]) 

X is (B*F-C*E) /DEN, 

Y is (A*F-C*D) / (-DEN) , 

i 



midpoint ( [XI, Yl] , [X2, y 2] , [MX, MY] ) 
MX is 0.5* (X1+X2) , 

MY is 0.5* (Y1+Y2) , 



partition (P, [ [XI, Yl] , [X2, Y2] ] , [PX, PY] ) : - 

PX is P* (X2-X1) + XI, 

PY is P* (Y2-Y1) + Yl, 

i 

perpendicular ( [PX, PY] , [A, B,_] , [PX, PY] ) : - 

A =:= 0.0, B =:= 0.0, 

writeln (' WARNING (line) .. .perpendicular to degenerate line'), 

I 

perpendicular ( [PX, PY] , [A, B, C] , [X, Y] ) : - 

T is B*PX - A*PY, 

D is A*A + B*B, 

X is (A*C + B*T) /D, 

Y is (B*C - A*T) /D , 

i 



/* 

heading - returns bearing 0..359+ for ray from [XI, Yl] thru [X2,Y2] 
*/ 



heading ( [X, Y] , [X, Y] ,_) : - 

write_list ( [ ' WARN (line) .. .degen line' , [X, Y] ,' has no heading']), 
! , fail . 

heading( [XI, Yl] , [X2, Y2] ,H) 

Y2<Y1, X2<X1, 

heading2 ( [X2,Y2], [X1,Y1],H2), 

H is H2+180.0, 

i 

heading( [XI, Yl] , [X2, Y2] ,H) 

Y2<Y1 , 

heading2 ( [X2 ,y 2] , [XI, Yl] ,H2) , 

H is 180.0-H2, 

i _ 

heading ( [XI, Yl] , [X2,Y2],H) 

X2<X1, 

heading2 ( [X2, Y2] , [XI, Yl] ,H2) , 

H is 360.0-H2, 
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I 



heading ( [XI, Yl ] , [X2,Y2],H) 

heading2 ( [XI, Yl] , [X2, Y2] ,H) , 

I 

heading2( [X1,Y1], [X2,Y2],H) 

DX is X1-X2, DY is Y1-Y2, 
fabs (DX, ADX) , fabs (DY, ADY) , 
ADX>ADY, 

Q is ADY/ADX, atan{Q,AT), 

H is 90. 0- ( 57 . 29577951 * AT), 

; 

heading2 ( [XI, Yl] , [X2, Y2] ,H) 

DX is X1-X2, DY is Y1-Y2, 
fabs (DX, ADX) , fabs (DY, ADY) , 

Q is ADX/ADY, atan(Q,AT), 

H is 57.29577951 * AT, 

i 



/* 

relative_heading - clockwise difference (0..359+) between 2 headings 
back_heading - used to link edges and find regions 



*/ 



relative_heading (HI, H2, H3) H3 is H2-H1, H3>=0, !. 

relative_heading(Hl,H2,H3) H3 is 360-(Hl-H2), !. 

back_heading (H, HB) : - H < 180.0, HB is H+180.0, !. 

back_heading (H, HB) HB is H-180.0, !. 
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B.4 USER INTERFACE 



START.PL - general start sequence and user interface 



: - use_module ( library ( files) , [f ile_exists/l ] ) , 
use_module (library (ctypes) , [is_endf ile/1 ] ) . 

% shorthand (s, start, sO, 1) . % for reference only 

% shorthand (g, goal, gO, 2) . 

start % interactive session 

els, 

bold, nl, 

prompt (_,' Enter MAP name: '), read (MAP), 
root (ROOT) , 

concat (ROOT, ' lib/' , LIB) , 
concat (LIB, MAP, LIBMAP) , 
alloff, nl, 
pre (LIBMAP) , 

start_prowindows, % contained in pwin.pl 

writeln (' Coordinate format is [x,y]. Range [ 0 . . 100, 0 . . 100 ] . ' ) , 
enter_point (s) , 
enterjpoint (g) , 
tail_sequence, 

i 

start (N, MAP, S, G) % background job 

root (ROOT) , 

concat (ROOT, ' lib/' , LIB) , 

concat (LIB, MAP, LIBMAP) , 

pre (LIBMAP) , 

set_sg (s, S) , 

set_sg (g, G) , 

show__parms , 

go, 

stats (N) , 

i # 

start (N, MAP, S,G) 

writeln (' WARN (start) . . . failed to start !') , 

write_list ( [ ' Prob No.',N]), 

write_list ( [ ' Map =',MAP]), 

write_list (['Start =' , S] ) , 

write_list ( [ ' Goal =',G]), 

i 
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new new(s), new(g), !. 
new(X) 

nl/ 

retracts 11 (ep(X,_,_,_,_) ) , 
mapname (MAP) , 
shorthand (X, XXXX,_,_) , 

write_list ( [ ' Reinitialize' , XXXX, 'for' , MAP] ) , 

writeln (' Coordinate format [x,y]. Range [ 0 . . 100, 0 . . 100 ] . ' ) , 

enter_point (X) , 

tail_sequence, 

j 

enter_jpoint (s ) 
bold, nl, 

prompt (_,' Enter new START: '), read(P), 
alloff , 
set_sg (s, P) , 
w_showsg (s) , 

i 

enter_point (g) 
bold, nl, 

prompt (_,' Enter new GOAL: '), read(P), 

alloff, 

set_sg (g, P) , 

w_showsg (g) , 

i 



% 

store :- mapname (M) , store (M) . 
store (M) 

concat (M, ' .pre' , MPRE ) , 
save (MPRE, 1) , 
reinitial . 
store (_) . 

reinitial w_init, tail_sequence . 

recall mapname (M) , recall (M). 

recall (M) : - 

concat (M, ' .pre' , MPRE) , 
recall2 (MPRE) . 

recall2 (MPRE) 

f ile_exists (MPRE) , 
kill_prowindows , 
restore (MPRE) , 

i 
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recall2 (MPRE) 

write_list_b ( ['WARN. . .state' , MPRE, ' cannot be loaded' ] ) , 
writeln (' Issue ''start.'' command.'). 

tail_sequence : - 
show_j)arms, 
nl, 

writeln_b(' COMMANDS '), 
writeln ('go. begin execution'), 
writeln (' new (s) . reset start'), 
writeln (' new (g) . reset goal'), 
writeln (' store . save preprocessed map'), 
writeln (' recall . recall this map'), 
writeln (' gtrace (X) . graphics tracing:'), 
writeln(' 1 ALL algorithms'), 
writeln (' d DISCRETE approximations'), 
writeln (' i RELAXATION (iteration)'), 
writeln (' 0 trace OFF'), 
writeln_b ( ' ' ) . 

show_parms : - % order is SIGNIFICANT 

w_showdata (time, 0.0), 
di(DI) , 

w_showdata (di,DI) , 
deltak (DK) , 

w_showdata (deltak, DK) , 

I 

showjarms !. 

SET_SG - given s(S) and g(G), finds RS,RG regions containing them; 
algorithm is based upon fact that a convex region cannot have 
2 consecutive vertices whose heading difference from an 
arbitrary interior point exceeds pi radians (180 deg) 




: - dynamic 

hd/2, % hd(v,h) . heading from s/g to v is h 

start/2, % start (p0 , rO ) . start and region containing it 

goal/2. % goal (pi, rl). goal and region containing it 

set_sg(X,P) 

retractall (hd(_,_) ) , 
f ind_region (X, P, R) , 

Shorthand (X,XXXX,_,_) , 

OLD =. . [XXXX,_,_] , 

retractall (OLD) , 

NEW =. . [XXXX, P , R] , 
asserta (NEW) , 
set_sg_arcs (X) , 

! 
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f ind_region (X, P, R) 
rv (R, W, VLST) , 
fanout (P , VLST) , 
not (same (W, 0 ) ) , 
shorthand (X, XXXX,_,_) , 
write_list ( [XXXX, P, ' in region' , R] ) , 

j 

f ind_region (_, P,_) 

write_list_b ([' ERROR (start )... invalid instance . P , ' is ']) , 
writeln_b(' inside obstacle, outside border, or on vertex.'), 
prowindows_exists, 

i 

fanout (P, [VO I VLST]) 

get_heading (P, VO, HO) , 
fanfwdt [VO, HO] ,P,V0,H0, VLST) , 

i 

get__heading (_, V, H) hd(V,H), !. % return if already computed 

get_heading (P, V, H) % else 

heading (P , V, H) , % compute heading from P to V 

asserta (hd (V, H) ) , % cache result 

j 

fanfwd ( [VO, HO] , P, VI, HI, [ ] ) % close the circle 

deltah (HI, H0,DH) , 

• t 

DH < 180.0, 

fanfwd(VH,P, VI, HI, [V2 I VLST] ) 
get_heading (P, V2, H2) , 
deltah (HI, H2,DH) , 

I 

• / 

DH < 180.0, 

fanfwd (VH,P,V2,H2, VLST) , 



deltah (HI , H2 , DH) H2 > HI, DH is H2-H1, !. 

deltah (HI, H2,DH) DH is H2-H1+360.0, !. 

% 

set_sg_arcs(X) 

ret ract_old_sg_arcs (X) , 
get_p_r (X, P, R) , 
re (R, W, ELIST ) , 

asserta (edge (X, [P, P] , [W, W] , X, X) ) , 
asserta (edge_data (X, 0 . 0, P) ) , 
asserta (er (X, [R, R] , [W, W] ) ) , 
gen_sg_ep (X, P, R, W, ELIST) , 
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rv (R, _, VLIST) , 

gen_sg_choke_ep (X, P, R, W, VLST) , 
st raight_line_ep, 

I 

set_sg_arcs (_) writeln ( ' set_sg_arcs failed.' ), !. 

retract_old_sg_arcs (X) : - 

retractall (edge (X, ) , 
retractall (edge_data (X,_,_) ) , 
retractall (er (X,_,_) ) , 
retractall (ep (X, ) , 
retractall (ep (_, X, _,_,_) ) , 

! 

st raight_line_ep re- 
start ( S , R) , 
goal (G, R) , 
re (R, W,_) , 

wdi stance (S, G, W, WD) , 
assert a (ep (s, g, R, W, WD) ) , 

] 

st raight_line_ep !. 

gen_sg_ep (_, []) . 

gen_sg_ep (X, P , R, W, [E | ELIST] ) 

not (edge (E,_, [_ r 0 ] ,_,_) ) , 
edge_data (E,_,MP) , 
wdistance (P , MP , W, WD) , 
assert a (ep (X, E, R, W, WD) ) , 
gen_sg_ep (X, P , R, W, ELIST) . 

gen_sg_ep (X, P, R, W , [_J ELIST]) 

gen_sg_ep (X, P , R, W, ELIST) . 

g en _sg_choke_ e p (_, []) . 

gen_sg_choke_ep(X,P,R,W, [V|VLST]) 
chr (EC, V,_) , 
wdistance (P , V, W, WD) , 
assert a (ep (X, EC, R, W, WD) ) , 
gen_ sg_choke_ ep (X, P, R, W, VLST) . 

gen_sg_choke_ep (X, P, R, W, [V|VLST]) 

gen_sg_choke_ep (X, P , R, W, VLST) . 
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MOUSE.PL - mouse driver for UDPGA* and Path Annealing with ProWindows 
======================================================================*/ 



dynamic mse/1. 

mse(sO) . % designate start point first by default 



use_module (library (dialog) ) , 
use_module (library ( interpret_messages ) ) , 
use_module (library (messages) ) . 



pixels (500) .% total number of map pixels in x and y directions 

map_size ( 100) .% total number of map units in x and y directions 

map_item(0xcoord, text_item ( ' X : 0 , none) , below, [width: 4]). 

map_item (0ycoord, text_item ( ' Y: ', 0 , none) , below, [width : 4]). 
map_item (Omstart , button (' Start Pt ' , m_start ) , below, []). 
map_item (Omgoal, button ('Goal Pt',m_goal), below, []). 

map_item (0mgo, button('GO', m_go) , below, []). 

map_item (0mstore, button (' Store' , m_store) , below, []). 

map_item ( @mrecall, button ( ' Recall' , m_recall) , below, [ ] ) . 

map_item (Ompost , button (' Print ', m__post ) , below, []). 

map_item (0mwinit , button (' W_Init ', m_w_init ) , below, []) . 

map_item (0mnewmap, button (' New Map' , m_newmap) , below, []) . 

map_item (0mkill, button ('Kill Mouse' , m_kill) , below, []). 

map_item (0msusp, button (' Suspend' , m_suspend) , below, []) . 

map_item (0mhalt , button (' Quit ', m_quit) , below, []). 

calculate_dim 

pixels (P) , 
map_size (C) , 

G is P/C, 

IG is P//C, 

assert (pm_ratio (G) ) , 

assert (ipm_ratio (IG) ) . 

exterminate 

dest roy (0map__dialog) , 
destroy (0mstart) , 
destroy (0mgoal) , 
destroy (0mkill) , 
destroy (0mgo ) , 
destroy (0mstore ) , 
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destroy (@mrecall) , 
destroy (@mwinit) , 
destroy (@xcoord) , 
destroy (@ycoord) , 



mouse : - 

exterminate, % exterminate old mouse stuff 

calculate_dim, 

send (@pic, smart, of f ) , 

new_dialog (@map_dialog, 'Mouse Ctrl' ,map_item) , 
send ( @map_dialog, open, point (510 , 470 ) ) , 
mloop . 

mloop : - 

send (@pic, cursor_x, cascade (@xcoord, adjustx, 0) ) , 
send (@pic, cursor^y, cascade (Gycoord, adjust y, 0 ) ) , 
send (@pic, left_up, cascade (@pic, clicked, 0) ) , 
interpret_messages (fail) . 



clicked(PIC,_) 
mse (P0) , 

get_ref (@PIC, las t_c lick, PT) , 
get (PT , x, XPIX) , 
get (PT, y , YP IX) , 

Convert__pt ( [XPIX, YPIX] , [X, Y] ) , 
click_sg(P0, [XPIX, YPIX], [X,Y]), 

j 

click_sg (sO, [XPIX, YPIX], [X,Y]) 
set_sg (s, [X, Y] ) , 

% retractall (start (_,_) ) , 

% asserta (s ( [X, Y] ) ) , 

send (@s0, pen, 1) , 

send (@s0, center, point (XPIX, YPIX) ) , 
w_showdata (start , [X, Y] ) , 

i 

click_sg(gO, [XPIX, YPIX], [X,Y]) 
set_sg (g, [X, Y] ) , 

% retractall (goal (_,_) ) , 

% asserta (g ( [X, Y] ) ) , 

send (@g0, pen, 2 ) , 

send (0gO, center, point (XPIX, YPIX) ) , 
w_showdata (goal, [X, Y] ) , 

i 
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m_start(_,_) retractall (mse (_) ) , asserta (mse (sO) ) , !. 

m_goal(_,_) ret ractall (mse (_) ) , asserta (mse (gO) ) , !. 

m_go go. 

m_store(_,_) store. 

m_recall (_, _) recall. 

m_post(_,_) w_j>ost. 

m_w_init (_,_) w_init. 

m_kill(_,_) exterminate, abort. 

m_newmap (_,_) start. 

m_suspend (_,_) writeln (' Mouse suspended. . .hit A D to return.')/ break. 
rn_quit (_, _) halt. 



ad justx (XITEM, X) % display transformed x in dialog box 

pm_ratio (R) , 

XX is X*10/R, 
floor (XX, RX) , 

send (0XITEM, select ion, RX) . 

ad justy ( YITEM, Y) % display transformed y in dialog box 

pm_rat io (R) , 
map_size (M) , 

YY is ( 1 0 *M) -Y*10/R, 
floor (YY, RY) , 

send (0 YITEM, selection, RY) . 

convert_pt ( [PX,PY] , [X, Y] ) 
pixels (W) , 
pm_ratio (G) , 

XX is PX/G, 

YY is (W-PY) /G, 
round (XX, X) , 
round (YY, Y) . 

convert_pix ( [X, Y] , [PX, PY] ) : - 

pixels (W) , 
pm_ratio (G) , 

TPX is G*X, 

TPY is W-G* Y, 
round (TPX, PX) , 
round (TPY, PY) . 
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PWIN.PL - ProWindows: windows and tracing of algorithms 



: - dynamic 

timer/0, 
ws_switch/0 , 
wnos/ 0, 
rnos/0, 
enos/0, 
detail_d/0, 
detail_i/0 . 

% enos. 

% rnos . 
wnos . 



% time display for interactive runs w/o ProWindows 

% switch: display region weights 
% switch: display region index numbers 
% switch: display edge index numbers 
% discrete point (udp) tracing switch 
% iteration (spr) tracing switch 



% default 



/* 

graphical tracing ON(l) / OFF(O) default = all OFF(O) 

*/ 



:- retractall (detail_d) , retractall (detail_i ) . % init switches 

gtrace gtrace(l). 

gtrace(l) :- t_set (detail_d) , t_set (detail_i) . 
gtrace (i) :- gtrace (0), t_set (detail_i) . 

gtrace (d) gtrace (0), t__set (detail_d) . 
gtrace (0) :- 

retractall (detailed) , 
retractall (detail_i) , 
destroy (0iter) . 

t_set(D) :- 

prowindows_exists , 
retractall (D) , 
assert (D) , 
warn (0) , 
create_iter , 
warn ( 1 ) . 
t_set (_) : - 

writeln (' CANNOT trace graphics ... ProWindows NOT running.'), 
fail . 



% both ON 
% iteration ON 
% discrete ON 
% both OFF 



o 

o 



create_iter :- new (0iter, figure (0, 0, 0) ) , send (@pic, display, 0iter) . 
create_iter. % already exists 
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warn(l) prowindows_exists , send (@sys , warnings , on) . 
warn(O) prowindows_exist s , send (@sys, warnings, of f ) . 
warn ( ) . 



start_prowindows 



% attempt to start prowindows 



prowindows, nl 
w init. 



startjprowindows 



% prowindows CANNOT be started 



writeln (user, ' NOTE .. .All screen output will be textual.'), nl. 



w__init 

kill_prowindows, 
prowindows , 
mapname (MN) , 
grey_bitmap, 
black_bitmap, 
display_jnap (MN, @pic) , 
showtitle, 
w_initlbls, 

reestablish_jdetail__status, 

create_sg (sO ) , 

create_sg (gO) , 

w__showsg (s) , 

w_showsg (g) , 

w_initparms , 

% new (Qpath, path) , % used when erasing and replacing paths 



create_sg (CIR) 

shorthand CIR, TH) , 
new (@CIR, circle) , 
send ( @CIR, radius , 5) , 
send (0CIR, pen, TH) , 
initial_place (CIR) , 
send (@pic, display , @CIR) . 

init ial_place (sO ) send (@s0, center, point (425, 565) ) . 

initialjlace (gO) : - send (@g0, center, point (425, 585) ) . 

reestablish__detail_status 

( detailed ; detail_i ) , 
new (@ iter, figure (0,0,0)), 
send (@ pic, display, 0 iter) , 



mouse 



w init 



% ProWindows warns if it cannot start 



reestablish detail status ! 
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w_showsg(SG) 

prowindows_exists, 
get_p_r (SG, P,_) , 
shorthand (SG, STRING, CIR, TH) , 
convert_jpix (P, [XPIX, YPIX] ) , 
send (0CIR, pen, TH) , 

send(@CIR, center, point (XPIX, YPIX) ) , 
w_showdata (STRING, P) , 

i # 

w_showsg(SG) : - 

g et _p_r (SG, P,_) , 
shorthand (SG, XXXX,_,_) , 
write_list ( [XXXX, ,P] ) , 

i 

w_showsg(SG) 

shorthand (SG, XXXX, _,_) , 

write_list_b ( [ ' NO' , XXXX, ' point established . ' ] ) , 

i 

get__p_r (s, P, R) start (P,R), !. 

get_p_r (g, P, R) goal(P,R), !. 

shorthand (s, start, sO, 1) . 
shorthand (g, goal, g0,2) . 

% 

w_pin(P) % used to highlight a point X, Y 

prowindows_exists, 
ptransf orm (P, [SX,SY]), 

XI is SX+12, % diagonal arrow 

Y1 is SY-12, 

new (@P, circle (XI, Yl, 5) ) , 
send (@P, pen, 4) , 
send (@pic, display, @P) , 
new (@L, line (XI, Yl, SX, SY) ) , 
send (@pic, display, @L) , 

i 

w_pin(P) write_list ([' WARNING .. .pin point placed on',P]), !. 

w_jpoint (P , RADIUS ) % used to highlight a point X, Y 

prowindows_exists, 
ptransform(P, [SX, SY] ) , 
new (@PT, circle (SX, SY, RADIUS ) ) , 

% send (6PT, fill, @black) , % option to fill 

send (@PT, pen, 5) , % option to thicken 

send (@ pic, display, @PT) , 

% EXT is RADIUS+2, % option to extend crosshairs 

% crosshairs ( [SX, SY] , EXT) , % option for crosshairs 

i 

w_point (_,_) !. 
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% crosshairs 



crosshairs ( [ SX, SY] , EXT ) 

XI is SX+EXT, 

X2 is SX-EXT, 

Yl is SY+EXT , 

Y2 is SY-EXT , 

new ( 0LH, line (XI , SY, X2 , SY) ) , 
new(0LV,line(SX,Yl,SX,Y2) ) , 
send (0pic, display, 0LH) , 
send (@pic, display, @LV) , 

j ^ 

w_edge(E) % used to highlight an edge E 

prowindows_exists, 
edge_data (E,_, MP) , 
pt ransf orm (MP, [SX, SY] ) , 
new (0RING, circle (SX, SY, 9) ) , 
send ( 0pic, display, 0RING) , 

I 

w_edge (_) : - ! . 

w_clear__iter 

(detail_d ; detail_i) , 
send (0iter, destroy) , 
new (0 iter, figure (0,0,0)), 
send (0pic, display, 0iter) , 

i 

w_clear__iter !. 

w_show_iter (PATH, TH) : - 
detail_i, 
new (0 ITER, path) , 
append_points (0, 0 ITER, PATH) , 
send ( 0 ITER, pen, TH) , 
send (0iter, append, 0 ITER) , 

i # 

w_show_iter (_,_) !. 

w_show_line (PI , P2 , TH) 
detail_d, 

ptransf orm (PI, [SXl, SYl] ) , 

pt ransf orm (P2 , [SX2, SY2] ) , 

new (0L, line (SXl, SYl, SX2 , SY2 ) ) , 

send (0L, pen, TH) , 

send (0 iter, append, 0L) , 

j 

w show_line (_, _, _) !. 



w__showpat h ( PATH ) : - 

prowindows_exists. 
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destroy (@path) , % used when erasing and replacing paths 

display_jpath (@path, PATH, @pic, 2) , 

% display_path (@P, PATH, @pic, 3) , 

i 

w_showpath (_) : - !. 

w^showdata (CAT, DATA) : - 
prowindows_exists , 
code (CAT,_, X, Y) , 
spacing (S) , 

XD is X+S, 

type_convert (DATA, SDATA) , 
destroy (0CAT) , 

new (@CAT, text (SDATA, XD, Y, left) ) , 
send (0 CAT, font, font (screen, b, 14) ) , 
send (0 pic, display, 0CAT) , 

j 

w_showdata (t ime, DATA) screen^t imer (DATA) , !. 

w_showdata (pacost ,_) % displayed by sa.pl 

w_showdata (CAT, DATA) : - write_list ( [CAT, ' =' , DATA] ) , ! . 

screen_t imer (DATA) timer, writeln (DATA) , backup, !. 
screen_timer (_) !. 

type_con v ert (DATA, SDATA) : - 
is_list (DATA) , 

Concat_atom(DATA, ' , ' , SDATA) , 

I 

type^convert (DATA, SDATA) : - make__string (DATA, SDATA) , ! . 

/* 

window sequence display routines 

*/ 



w_wsinit 

prowindows_exists , 
w_clear_ws , 
new (0ws2, path) , 

i 

w_wsinit : - ! . 

w_clear_ws 

prowindows_exists , 
retractall (ws_switch) , 
destroy (0wsl) , 
destroy (0ws2 ) , 

j 

w_clear_ws I. 

destroy (OBJ) object (OBJ) , send (OBJ, destroy) , !. 

destroy (_) !. 
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w show ws (L) : - 



prowindows_exists 
get_midpts (L, LM) , 
swap_ws (LM) , 



w _show_ws (__) : - ! * 

get_midpts ([],[]) ! . 

get_midpts ( [ E | LE] , [M | LM] ) 
edge_data (E, _, M) , 
get__midpts (LE, LM) , 



swap_ws (LM) retract (ws_switch) , w_ws (0 wsl , 0 ws2 , LM) , !. 

swap_ws (LM) assert (ws__switch) , w__ws (0ws2 , @wsl, LM) , !. 

w w s (0WS1, GWS2, LM) : - 

new (0WS2 , path) , 
append_points (0, 0WS2, LM) , 
send (0WS2, pen, 2) , 

% send ( 0WS2 , smooth, on) , % smoothing option 

send (0WS1, destroy) , 
send (0 pic, display, 0WS2) , 



append_jpoints (_, _, (] ) ! . 



append_points (SW, 0PATH, [ [_, [X, Y] ] |L] ) 
pt ransf orm ( [X, Y] , [IX, IY] ) , 
new (0PT, point (IX, IY) ) , 
send (0PATH, append, 0PT) , 
turn_mark(SW, (IX, IY]), 
append_point s (SW, 0PATH, L) , 



% discrete paths 



% SW=1, mark turns by '+' 



append_points (SW, 0PATH, [ P | L] ) 



ptransf orm (P, [IX, IY] ) , 
new (0PT, point (IX, IY) ) , 
send (0PATH, append, 0PT) , 
turn_mark (SW, [IX, IY] ) , 



% SW—1 , mark turns by 



append_points (SW, 0PATH, L) , 



turn_mark ( 1, [IX, IY] ) 

TXTIY is IY+1, 

new (0TXT, text ('+' , IX, TXTIY, center ) ) 
send (0 TXT, font, font (screen, b, 12) ) , 
send (0pic, display, 0TXT) , 



% correct text center 
% turn marks are '+' 



turn_mark ( 0 , _) : - ! 
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/* 

print routines 

*/ 



wjpost prowindows_exists, w_post(ssl). 

w__post (PRT) 

prowindows_exists, 

send (@ pic, postscript , pspicf ile) , 

send_to (PRT) , 

% unix (system (' rm pspicfile' ) ) , 

concatenate (' lpq -P' , PRT, QPRT) , 
unix (system(QPRT) ) . 
w_post (_) . 

send_to(ssl) unix (system(' lpr -Pssl pspicfile')). 

send_to(upl) unix (system (' lpr -Pupl pspicfile')). 

send_to(up2) unix (system(' lpr -Pup2 pspicfile')). 

send_to (secs) unix (system (' lpr -Psecs pspicfile')). 

send_to (phd) unix (system (' lpr -Pphd pspicfile')). 

/* 

preparation of map display 

*/ 



display_map (MAP, PIC) : - 

algorithm_type (ALG) , % set in make file 

name (ALG, NALG) , 

name ( ' - ',NSPC), 

name ( MAP , NMAP ) , 

append (NALG, NSPC,NLBL1) , 

append (NLBL1, NMAP, NLBL2) , 

name (LABEL, NLBL2 ) , 

new (PIC, picture (LABEL, size (500, 700) ) ) , 
send (PIC, horizontal_scrollbar, 0) , 
send (PIC, vertical_scrollbar , 0) , 
send (PIC, open, point (620,70)), 
ticks, 

new (@map, figure (0,0,0)), 
send (0map, can_move, of f ) , 
append_edges (@map) , 
send (PIC, display, @map) , 
f ill_obstacles, 



ticks 

xticks (100, 0) , 
yticks (0, 100) , 
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xticks (X, Y) : - 
X >= 0 , 

xt ransform (X, TX) , 
yt ransform (Y, TY) , 

new (@TXT, text (' | ' , TX, TY, center) ) , 
send(0TXT, font, font (cour,b, 10) ) , 
send(@pic, display, @TXT) , 

X2 is X-10, 
xticks (X2 , Y) , 

t # 

xticks (_,__) : - ! . 

yticks (X, Y) : - 
Y >= 0, 

xtransf orm (X, TX) , 
ytransf orm (Y, TY) , 

new ( @TXT, text ( ' , TX, TY, center ) ) , 
send ( @TXT , font , font (cour, b, 18 ) ) , 
send (@pic, display, @TXT) , 

Y2 is Y-10, 
yticks (X, Y2 ) , 

f 

yticks (_,_) !. 

append_edges (@FIG) : - 

edge (E, [V1,V2], [Wl, W2] ,_,_) , 

% not (same (W1,W2) ) , % phantom edges not displayed 

not (same (E, s ) ) , 
not (same (E, g) ) , 
midpoint (V1,V2,MP) , 
pt ransform (VI, [PX1,PY1]), 
pt ransform (V2 , [PX2 , PY2 ] ) , 
pt ransform (MP, [PXM,PYM] ) , 
new (6LIN, line (PX1 , PY1 , PX2 , PY2 ) ) , 

% send (0LIN, arrows, first ) , % visual check edge consistency 

send (@FIG, append, @LIN) , 
enos, 

new (@TXT, text (E, PXM, PYM, center) ) , 
send (0 TXT, font, font (cour, b, 10) ) , 
send (0 pic, display, 0TXT) , 
fail. 

append__edges (__) ( enos ; region^lbls ), !. 

region_lbls 

rv (R, W, VLST) , 

not (same (W, 0 ) ) , 

avg_vlst (VLST, VO) , 

pt ransform (VO , [PX,PY]), 

get_region_lbl (R,W, L) , 

new ( 0 RWT , text (L, PX, PY, center) ) , 

send ( 0 RWT , font, font (cour, b, 10) ) , 
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send (0pic, display, @RWT) , 
fail . 

region_lbls !. 

get_region_lbl (R, _, R) rnos, !. 

get_region_lbl (_, W, W) wnos, !. 

nos (N) 

retractall (enos) , 
retractall (rnos) , 
retractall (wnos) , 

( N == e -> assert (enos) 

I N == r -> assert (rnos) 

| N == w -> assert (wnos) ) . 

avg_vlst ( VLST , [X, Y] ) : - 

accum_vlst (VLST, [TX, TY] ) , 
length (VLST, L) , 

X is TX/L, 

Y is TY/L, 



accum_vlst ( [] , [0 . 0, 0 . 0] ) !. 

accum_vlst ( [ [X, Y] | VLST] , [XCM, YCM] ) 
accum_vlst (VLST, [XSB, YSB] ) , 
XCM is XSB+X, 

YCM is YSB+Y, 



% L = [ [xl, yl] , [x2, y2] , . . . , [xn, yn] ] 



% TH = thickness in pixels (1 default) 



ptransf orm ( [X, Y] , [SX,SY]) 
xtransf orm (X, SX) , 
yt ransf orm (Y, SY) , 

i 

xtransf orm (X, IX) 

XX is X*5, 
round (XX, IX) , 

i 

ytransf orm (Y, IY) 

YY is (100-Y) *5, 
round (YY, IY) , 

t 



display_path (@PATH, L, PIC, TH) 
new (0PATH, path) , 
append_points ( 0 , QPATH, L) , 
% append_points (1, 0PATH, L) , 

send (0PATH, pen, TH) , 
send (PIC, display, 0PATH) , 
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grey_bitmap : - 

new (0PATTERN, bitmap ( 2 , 2 )) , 

send_list (0PATTERN, set, [point (0,0) , point (1,1) ] ) , 

new (@grey, bitmap (64,64)), 

send (0grey, replicate, 0PATTERN) . 

black_bitmap 

new ( 0 PATTERN, bitmap (2,2) ) , 
send_list ( 0PATTERN, set, 

[point (0,0) , point (0,1) , point ( 1 , 0 ), point ( 1 , 1 )]) , 
new (Sblack, bitmap (64,64)), 
send (0black, replicate, 0PATTERN) . 

% send__list (0PATTERN, set , [ ] ) , % what white would look like 

w_initlbls 

code (CAT, LABEL, X, Y) , 

new (0LBL, text (LABEL, X, Y, left) ) , 

new (@CAT, text (' ',0,0, left) ) , 

send(0LBL, font, font (screen, b, 14) ) , 

send (0pic, display , 0LBL) , 

fail. 

w_initlbls !. 

decode (TERM, SDATA, CAT, XD, Y) : - 
TERM =. . [CAT, DATA] , 
make_string (DATA, SDATA) , 
code (CAT, X, Y) , 
spacing (S) , 

XD is X+S, 



make_string (DATA, STRING) : - 
number (DATA) , 
number__chars (DATA, CLIST) , 
atom_chars (STRING, CLIST) , 

i # 

make_string (DATA, STRING) : - 
a tom (DATA) , 
name (DATA, CLIST) , 
atom_chars (STRING, CLIST) , 

i 

make__st ring (DATA, __) 
var (DATA) , 

writeln (' ERROR (pwin) ... cannot make string from variable'), 

i 

make^string (DATA,__) 

write_list ([' ERROR (pwin) .. .unknown data type :', DATA] ) , 
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concatenate (SI, S2, S3) : - 

name (SI, LI) , 
name (S2, L2) , 
append (LI, L2, L3) , 
name (S3, L3) , 

t 

showtitle : - 

mapname (MN) , 

algorithm_type (ALG) , 

concatenate (ALG, ' - ' , TITLE1 ) , 

concatenate (TITLE1, MN, TITLE) , 

new (Gttl, text (TITLE, 250, 530, center) ) , 

send (Gttl, font, font (screen, b, 16) ) , 

send (Gpic, display, Gttl) , 

new (G dates tmp, text (' ',250,660, center) ) , 
send (G dates tmp, font , font (screen, b, 14 ) ) , 
send (Gpic, display, Gdatestmp) , 

t 

spacing ( 150 ) . 



code(pacost, 'best path ', 10,560). 

code(elcost, 'ellipse cost ... ', 10,580). 
code(di, 'discrete int ... ', 10,600). 
code(deltak, 'delta k ', 10,620). 

code (start, 'start point .... ', 260,560). 

code (goal, 'goal point ', 260,580). 

code(blankl, ' ', 260,600). 

code (time, ' cpu time used .. ', 260,620). 



update_clock (NEWTIME) : - 
tm(ETIME) , 

retract (time (TIME) ) , 
NEWTIME is TIME+ETIME, 
assert (time (NEWTIME) ) , 
w_showdata (time, NEWTIME) , 
tm, 

I 

w_initparms 

retractall (time (_) ) , 
assert a (time (0.0)), 
w_showdata (time, 0.0), 
di(DI) , 

w_showdata (di,DI) , 
deltak(DK) , 

w_showdata (deltak, DK) , 

! 

w_initparms !. 
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ds : - da tost amp (X) , ds2 (X) , !. 

ds2 (X) 

prowindows_exists , 
send (Gdatestmp, string, X) , 
fail, ! . 
ds2 (X) : - 

algorithm type (ALG) , 
nl’ 

writeln (' ' ) , 

write (ALG), % algorithm id 

write ( ' ' ) , 

writeln (X), % time stamp 

j 

datestamp(X) 

sys ( ' date>date' ) , 
open (date, read, S) , 
see (S) , 

fill_st ring (NLIST) , 
name (X, NLIST) , 
seen, 

sys ( ' rm date' ) , 

i 

fill string ( [C INLIST] ) 
getO (C) , 

not (is_endf ile (C) ) , 
f ill_ st ring (NLIST) , 

i 

fill_st ring ( (] ) !. 

f ill_obstacles : - 

rv (R, 0 , [ V | VLST ] ) , 

not (border (R) ) , 

append ( [V | VLST] , [V] , VL) , 

f ill_poly (VL) , 

fail. 

f il l_obstacles !. 

f ill_poly ( VL) 

new (0POLY, path) , 
append_point s (0, 0FOLY, VL) , 
send (0POLY, fill, Ggrey) , 
send (Gpic, display, 0POLY) , 
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B.5 UNIFORM-DISCRETE-POINT GLOBAL A* (UDPGA*) SEARCH 



UDPGA.PL - Uniform-Discrete-Point Global A* (UDPGA*) Search 

Approximates the globally optimal path by using A* search 
on the graph of evenly spaced points on each boundary edge, 
connected by arcs (segments) through common cost regions. 

Parameter di(I) is the upper bound for point to point spacing, 
uses HEAP in C to maintain agenda 

========== , =========================================================== */ 



A* SEARCH 

adapted from Rowe, N.C., 

"Artificial Intelligence Through Prolog," 
Prentice Hall, 1988, pp. 244-247. 



For an application, define 5 predicates: 

(a) successor (State, Newstate) 

(b) goalreached (State) 

(c) eval (State, Evaluation) 

(d) cost (Statelist, Cost ) 

(e) search: top-level predicate that initializes things, 
then calls astarsearch with two arguments, the starting 
state and variable which will be the solution path 



(gives state transitions) 
(defines when goal achieved) 
(estimates cost to the goal) 
(computes cost of a path) 



Note that "cost" must be nonnegative. The "eval" should be a lower 
bound on cost in order for the first answer found to be guaranteed 
optimal, but the right answer will be reached eventually otherwise 



At conclusion of processing: 

no. of items in agenda - 1 = no. of unexamined states 
no. of items in usedstate = no. examined states 



Modifications to original code: 

In this version, we modified cost to cost ( Statelist , OldCost , NewCost ) 
to reduce the work required to compute the cost of a new statelist. 
Also, we have replaced pick__best_j?ath rules with a more efficient 
version which maintains heap to find the minimum cost+eval on agenda 
more efficiently. Since heaps are not efficient in Prolog, the heap 
routines have been coded in C. 



The original code referenced in [Rowe88, pp. 244-247] states that if 
the evaluation function is ALWAYS a lower bound on the cost function, 
then faster performance results if we delete the first rule of 
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agenda_check and usedstate_check, and the entire definitions of 
fix__agenda and replace_f ront . We have determined that the first rule 
of agenda__check IS REQUIRED to guarantee optimality in a general 
graph (ie. NOT a tree) . Therefore, we have NOT excluded it. Since 
our evaluation function is Euclidean distance to the goal at lowest 
cost on the map, then it is a lower bound on cost. 

We have, therefore, modified the original code accordingly. 



: - dynamic 

ec *ge_j?t/2 , % edge_j?t (e, [x,y]) . 

usedstate/2, % usedstate ( [e, [x, y ] ] , cost), 

agenda/ 5, % agenda (i, [e, [x, y] ] , [[e, [x,y]], ..], cost , eval+cost ) . 



% dynamic: crude and refined versions 

successor/2, 

goalreached/1, 

eval/2, 

cost/3, % cost (state, oldcost, newcost) . 



time/1, 
di/1, 
deltak/1, 
solution/4 . 



% time (t ) . 
% overrides udp.pl 
% used for compatibility w/ pwin.pl, start.pl 
% solution (ws, path, cost , time) . 



di ( 8 ) . 

deltak (0.0) . 



% default setting 
% for compatibilty (NOT used in this algorithm) 



clean_ops 

retractall (successor (_,_) ) , 
retractall (goalreached (_) ) , 
retractall (eval (_,_) ) , 
retractall (cost (_, , ) ) , 



/* 

Crude search through midpoints in order to compute bounding ellipse 
NOTE: successor, goalreached, cost, and eval fns CANNOT have cuts ! 
*/ 



set_crude_ops :- 
clean__ops, 
asserta ( ( 

successor (E0, El) : - 

( ep(E0, El, _,_,_) ; ep (El , E0, _, _,_) ) 
) ) , 

asserta ( ( goalreached (g) )), 

asserta ( ( 
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eval (EO , EVAL) 
goal (GP,_) , 
edge_data (E0,_, MP) , 
distance (MP, GP, EVAL) 

)), 

asserta ( ( 

cost ( [EO , El |_] , OLDCOST, COST) 

( ep (EO , El,_,_, C) ; ep (El, EO, C) ) , 
COST is C+OLDCOST 
) ) , 

asserta(( cost ( [s] 0 . 0) )), 



/* 

Refined search through uniformly spaced (interval di) edge-points 
*/ 



set_ref ined_ops 
cleanups , 
asserta ( ( 

successor ([E0,P0],[E1,P1]) : - 

( ep (EO, El, ; ep (El, EO, 

; ref l_edge (EO , El ) ), % or reflection 

edge_pt (El, PI) , % PI must be a point on EO 

not (same (P0 , PI) ) % same points ==> no progress 

)), 

asserta ( ( goalreached ( [g, _] ) )), 
asserta ( ( 

eval ( [_, P0] , EVAL) % Eucl dist to goal at coef = 1 

goal (GP,_) , 

optimal_cost (W ) , 

wdi stance (P0 , GP , W, EVAL) 

)), 

asserta( ( cost ( [SO , SI |_] , OC, C) rcost ( SO f SI f OC, C) )), 
asserta ( ( cost ( [ [s, _] ] , 0 . 0 ) )), 



ref l_edge (EO, EO) : - not (edge (EO [W, W] ,_,_)) . 

rcost ( [E0,P0] , [E0,P1] , OLDCOST, COST) 

edge (EO, , [WO, ] , , ) , 

wdi stance (P0, PI, WO, C) , 

COST is OLDCOST + C. 
rcost ( [EO, P0] , [El, PI] , OLDCOST, COST) 

( ep (EO, El ,_, W,_) ; ep(El,E0,_,W,_) ), 

wdistance (P0, Pi, W, C) , 

COST is OLDCOST + C. 
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/* 

refined search data structure generation 
*/ 



gen_all_points % also generates records for s and g 

edge (E, V, 
not (same (W, 0) ) , 
get_pts (E, V, PLST) , 
make_records (E, PLST) , 
fail, ! . 

gen_all_points ! . 

make_records (_,[]) : - ! . 

make_records (E, [ [X, Y] |PLST] ) 

asserta (edge_pt (E, [X, Y] ) ) , % ensures hashing on E edge no. 

make_records (E, PLST) , 

f 



/* 

search driver 

*/ 



Crude A* search (init solution) 



) 



search 

w__initparms , 
unknown (_, fail) , 
reset_points, 
set_crude_ops, 
writeln (' Stage 1: 
ts, 

astarsearch (s, WS, 
writeln (WS) , 

opt imize_ws (WS , CrudePath, UCost , SCost ) , 

write_list ([' Crude path costs UDP =',UCost,' 

update_clock (Tl) , 

write_list ( [ ' time =',T1]), 

w_showpath (CrudePath) , 

avg_path_wt (SCost , CrudePath, APW) , 

% asserta (opt imal_cost (APW) ) , 

write_list ([' Average Weight =',APW]), 
tm, 

ellipse (SCost) , 
update_clock (T2) , 
write_list ( [ ' time =' , T2 ] ) , 

writeln (' Stage 2: Refined A* search (UDPGA*) 
set_ref ined_ops, 
gen_all_points, 
start (SP, _) , 

astarsearch ( [s, SP] , StateList, ACost ) , 
write_list ( [ ' A* search path cost =' , ACost]), 
separate (StateList, AWS,_) , 
writeln (AWS) , 



% display initial parameters 
% required by astarsearch 
% reset epts and edge-pt for udp.pl 



) 



SPR =' , SCost] ) , 



% heuristic ellipse 
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writeln (' Check WS for inconsistencies...'), 
f ix_ws (AWS, FixedWS) , 
writeln (FixedWS) , 

optimize_ws (FixedWS, SolutionPath, UOCost , OptCost ) , 
write_list ([' Optimal Path costs UDP =',UOCost]), 
write_list ( [' SPR =', OptCost ]) , 
update_clock (T3) , nl, 

% Cleanup and Housekeeping 
unknown (_, trace) , % reset after astarsearch 

w_showpath (SolutionPath) , 
w_showdata (pacost, OptCost) , 

write_list ( [ ' UDPGA* Optimal cost =', OptCost ]) , 
write_list ([' Finish time =',T3]), 

asserta (solution (FixedWS, SolutionPath, OptCost, T3) ) , 

notrace, % in case trace was on 

I 

search writeln_b (' ERROR (astar) . . .A* search failed !'), !. 

opt imize_ws (WS , PATH, C, COST) 
writeln ( ' UDP ...'), 
di jkstra (WS, P, C) , 
writeln (' SPR. . . ' ) , 

Solve (WS,P, PATH, COST) , 



separate ([],[],[]) ! . 

separate ( [ [E, P] I SL] , [E | WS] , [P | PA] ) separate (SL, WS, PA) , !. 



f ix_ws ( [ S | WS ] , CW) 

correct_ws (S,WS, WSO) , 
remove_bad_reentrant ( [ S | WSO ] , CW) , 



correct_ws (EO , [El], [El]) 

(ep(El,E0,R,_,_) ; ep (EO , El , R,_,_) ) , 

i 

correct_ws(El, [El, El | WS] , CW) 

correct_ws (El, [El |WS] ,CW) , 

i 

correct_ws(EO, [El, E2 | WS] , CW) 

(ep(E0,El,R,_,_) ; ep (E1,E0,R,_,_) ) , 

(ep (El, E2, R,_, _) ; ep (E2 , El , R,_,_) ) , 

correct_ws (EO, [E2 jWS] ,CW) , 

j 

correct_ws (_, [E1,E2 |WS] , [El | CW] ) 

Correct_ws (El, [E2|WS],CW), 

i 

correct_ws (E, WS , CW) 

writeln b (' ERROR (astar )... failed to fix WS !'), 



% end of ws 



% unnecessary El 



% unnecessary El 



% OK, continue 
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writeln_b (E) , 
writeln_b (WS ) , 
writeln_b (CW) , 



remove_bad_reent rant ( [EO] , [EO] ) . 

remove_bad_reentrant ( [El, EO] , [El, EO] ) ! . 

remove_bad_reentrant ( [El, E2, E2, E3 I WS] , Z) : - 

( ep (El, E2, R1 , Wl,_) ; ep (E2, El, Rl, Wl,_) ), 

( ep (E2, E3, R3, W3,__) ; ep (E3, E2, R3, W3, _) ), 
( not (same (R1,R3) ) -> Z=[E1,E2|CW] 

| edge (E2,_, [_, W3] ,_,_) -> Z= [El, E2, E2 | CW] 
| otherwise -> Z=[E1|CW] ), 
remove_bad_reentrant ( [E3 |WS] ,CW) , 

i 

remove_bad_reentrant ( [El | WS] , [El |CW] ) 
remove_bad__reent rant (WS,CW) , 



% continuous 
% OK 
% remove 



% OK, continue 



% 



a star search (Start , Goa Ipat hi ist , C) : - 
cleandat abase, 
add_state (Start, [ ] , 0 . 0 ) , 
repeat if agenda, 

pick_bes testate (I, State, Pa th list, C) , 
add_successors (I,State,Pathlist,C) , 
agenda (I, State, Goa Ipat hlist, C,_) , 

I 

pick_best_state (I, State, Pat hi ist , C) : - 
del^min ( I ) , 

agenda (I, State, Pa thl ist , C,_) , 

i 



% iterative loop 



% soln at top of agenda 



% delete top of heap 
% retract in add succ 



% add_successors succeeds only when best state on agenda includes goal 



add_successors (_, State, _,_) goalreached (State) , !. 

add_successors (_, State, Pathlist , C) % fail, add successors 

successor (State, Newstate) , 
proper (Newstate, Pathlist) , 
add_state (Newstate, Pathlist, C) , 
fail . 

add_successors ( I, State, C) % remove cur state, fail 

retract (agenda ( I, , , , ) ) , % pick_best (top heap) 

asserta (usedstate (State, C) ) , 
fail. 



proper ( [E0,PR2], [[E0,PR1], [El, Pi] |_] ) 

t 

• t 

er (EO, RO, [WO, ] ) , 



% reflection ? 
% fail rule if head match 
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er (E1,R1,_) , 
matcher ( RO , R1 ) , 

edge (E0,_, [WO, _],_,_) , % reflective side of edge ? 

sqr_dist (Pi, PR1, Dl) , 
sqr_dist (PI, PR2, D2) , 

D2 > Dl, % reasonable reflection ? 

! 

proper I . % no match to rule 1 head ==> no reflection, succeed 

match_r([R,_], [_, R] ) 
match_r ( [R,_] , [ R, _] ) !. 

match_r ( [_, R] , [_, R] ) !. 

match_r ( [_, R] , [R,_] ) !. 

add_state (Newstate, Pa t hi is t, C) : - 

cost ( [Newstate (Path list] , C, Cnew) , 

i 

• r 

agenda_check (Newstate, Cnew) , % fail if on agenda 

i 

• / 

usedstate_check (Newstate, Pathlist , Cnew) , % fail if seen before 

i 

♦ / 

eval (Newstate, Enew) , 

D is Enew + Cnew, 
ins_heap (D, I) , 

assert a (agenda (I, Newstate, [Newstate | Pathlist ] , Cnew, D) ) , 
update_clock (T) , 

display_newstate (Newstate, Pathlist) , 
tm, 

add_state (Newstate, Pathlist, C) : - 

not (cost ( [Newstate (Pathlist] ,C,_) ) , 

write_list_b ( [ ' ERROR (astar) . . .cost fail', [Newstate (Pathlist] ] ) , 

; 

add_state (Newstate, Pathlist , _) : - 

not (eval (Newstate, _) ) , 

write_list__b ( [ ' ERROR (astar) . . . eval fail' , [Newstate (Pathlist] ] ) , 

i 

% FOR DISPLAY DEBUG ON VT-100 WITHOUT PROWINDOWS 

% display_newstate ( [_, PO] , [ [_, PI] | ] ) : - write_list ([PI,' — >' , PO] ) . 

% display_newst ate ( [ s , ] , [] ) . 

display_newstate ( [_, PO] , [ [_, PI] |_] ) % refined DISPLAY 

w_show_line (Pi, PO, 2) , 

i 

display_newstate ( [ s,_] , [ ] ) !. % ignore refined start 
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% crude DISPLAY 



display_newstate (EO, [El | ] ) 

edge_data (E0,_, MPO) , 
edge_data (El,_, MP1) , 
w_show_line (MP0,MP1, 2) , 

t 

display_newstate (_, []):-!. % ignore crude start 



agenda_check - check for state S already on agenda; 

linear search for S which has greater cost back to start; 
remove and replace with shorter route; 
linear search to delete from heap; 

*/ 



agenda_check ( S , C ) : - 

agenda (I, S,_, C2,_) , 

€<02, 

retract (agenda (I ) , 
del_heap (I) , 

i 

agenda_check (S,_) agenda (_, S , !, fail. 

agenda_check (_/_). % else, if not on agenda, succeed and put on 

usedstate_check (S,_,_) usedstate (S,_) , !, fail. 

usedstate_check . 

repeatif agenda . % repeat while agenda NOT empty 

repeatif agenda agenda , repeatif agenda . 

cleandatabase 

retractall (agenda ) t 

retractall (usedstate (_,_) ) , 
init_heap (_) . 
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B.6 MAP MAKER 



MAPMAKER.PL - mouse assisted weighted- region problem map making tool; 
create/edit simple line maps for the weighted region problem; 
capture screen points, convert to map coordinates, and store 
as edge predicates; requires special version of ProWindows 
created with particular libraries from Quintus ProWindows. 



library_directory ( ' /usr/local/quintus/generic/qplib2 . 5/library' ) . 
library__directory ( ' /usr/local/quintus/pwl . 1/library' ) . 



make save (mm, 1), go. 

make writeln (' Created executable: mm'), halt. 



pixels (700) . 



% number pixels in one dimension 



map_size (100) . 

dynamic 

weights/1, 
point/1, 
pm_ratio/l, 
ipm_ratio/l , 
pix_edge/5 . 

weights ([1,1]) . 



% number map units in one dimension 



% initial default weight setting 



go : - 

kill_prowindows, 

retractall (pix_edge ) , 

precalc, 

make_map. 

kill kill_prowindows . 



use_module (library (basics) ) , 
use_module (library (dialog) ) , 
use_module (library (interpret_messages) ) , 
use_module (library (messages ) ) , 
use_module (library (strings) ) , 
use_module (library (math) ) . 

writeln (X) write (X) , nl, !. 
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midpoint ( [XI, Yl] , [X2, Y2] , [XM, YM] ) 
XM is 0.5* (X1+X2) , 

YM is 0.5* (Y1+Y2) , 



% 

map_item(@xcoord, text_item(' X: ', 0 , none) , below, [width: 4]). 
map_item (Qycoord, text_item ( ' Y: ', 0, none) , below, [width: 4]). 
map_item (@new_line, button ( ' New Ln' , cascade (@pic, new_line, 0 ) ) , below, [ ] ) . 
map_item(@mclear, button (' Clear ' , mmclear) , below, []) . 

map_item (@wt 1, text_item ( ' W1 : ' , 1 , cascade (@pic, setl , 0 ) ) , below, [width : 2] ) . 
map_item (@wt2, text_item( ' W2 : ' , 1, cascade (@pic, set 2, 0) ) , below, [width :2 ] ) . 

map_item(@blankl , label (' ' , 0) , below, [] ) . 

map_item (@lf ile, text__item ( 9 Load: ' , map, cascade ( @pic, stay, 0) ) , 
below, [width: 8]) . 

map_item(6mload, button (' Load' , mmload) , below, []). 
map_item(@blank2, label ( 9 9 , 0) , below, [] ) . 

map_item (@sf ile, text_item (' Save : ' , map, cascade (@pic, stay, 0) ) , 
below, [width : 8] ) . 

map_item(@msave, button (' Save' , mmsave) , below, []). 

map_item(@blank?, label (' ' , 0) , below, [] ) . 
map__item (0mprint , button (' Print 9 , mmprint) , below, []) . 
map_item (@blank4 , label ( ' 9 , 0 ) , below, [ ] ) . 
map_item(@mquit , button (' Quit ' , mmquit) , below, []). 

stay (_,_) 

send (@sf ile, advance, none) , 
send (01f ile, advance, none) . 

setl (_, STRW1) : - 

name (STRW1, L) , 
number_chars (W1 , L) , 
retract (weights ( [_, W2] ) ) , 
assert (weights ( [W1,W2] ) ) , 
send (@wtl, advance, next ) . 

set 2 (_, STRW2) :- 

name (STRW2, L) , 
number_chars (W2 , L) , 
retract (weights ( [Wl,_] ) ) , 
assert (weights ( [Wl, W2] ) ) , 
send (@wt2, advance, previous) . 
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ticks 

pixels (W) , 

T is W//10, 

WO is W-T, 
ticks2 (WO , T ) , 

I 

ticks2(X,T) : - 
X >= 1 , 

new (@TXT, text (' | ' , X, 0, center) ) , 
send (@ TXT, font, font (screen, r, 12) ) , 
send (0pic, display, 0TXT) , 

X2 is X-T, 
ticks2 (X2, T) , 

I 

ticks2 (_, T) : - 

pixels (W) , 
ticks3 (W, T ) , 

i 

ticks3 ( Y, T) : - 
Y >= 1, 

AY is Y-6, 

new (0TXT, text ( ' -' , 0 , AY, left) ) , 
send (0 TXT, font, font (screen, r, 12) ) , 
send (0 pic, display, 0TXT) , 

Y2 is Y-T, 
ticks3 (Y2, T) , 

i 

ticks3 (_,_) : - ! . 

precalc 

pixels (P) , 
map_size (C) , 

G is P/C, 

IG is P//C, 

assert (pm_ratio (G) ) , 

assert (ipm_ratio ( IG) ) . 



make_map : - 

pixels (P) , 
pm_ratio (G) , 

new ( 0pic, picture (none, size (P, P) ) ) , 
send (0pic, horizontal__scrollbar , 0 ) , 
send (0 pic, vertical_scrollbar , 0 ) , 
send (0pic, smart, of f) , 
round(G, IG) , 

send (0pic, grid, size ( IG, IG) ) , 
new_dialog (0map_dialog, none, map_item) , 
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send (@map_dialog, right , @pic) , 

PX is 1000-P, % screen = 1150x900 pixels; dialog = 150 wide 

send (0map_dialog, open, point (PX, 80) ) , 

send ( 0map_dialog, label, 'MAP MAKER' ) , 

stay (_,_) , 

draw_border, 

ticks, 

new (0 status, text_block (' ' , area (430,480,70,20) , center) ) , 
send (@pic, display, 0status) , 

send (@pic, cursor_x, cascade (0xcoord, ad justx, 0 ) ) , 
send(@pic, cursor_y, cascade (0ycoord, adjusty, 0) ) , 
send (@pic, moved, cascade (0pic,moved_line, 0) ) , 
send (@pic, lef t_down, cascade (@pic, clicked, 0 ) ) , 
send (@pic,middle_click, cascade (@pic, del_line, 0) ) , 
interpret__messages ( f ail) . 

new_line (_,_) ret ractall (point (_)) . % start new line 

del_line (_,FIG) 

send (FIG, destroy) , 

retract (pix__edge (FIG, WTLBL, ) , 
send (WTLBL, erase) . 

moved_line (PIC, FIG) 

retract (pix_edge (FIG, WTLBL, [XI, Yl] , [X2, Y2] ,W) ) , 

send (WTLBL, erase) , 

get (FIG, reference_point , REF) , 

send (FIG, destroy) , 

REF = . . [_, XR, YR] , 

NX1 is Xl+XR, NY1 is Yl+YR, 

NX2 is X2+XR, NY2 is Y2+YR, 
new (0L, line (NX1, NY1, NX2, NY2) ) , 

% send (@L, arrows, first ) , % option for arrowheads 

new (0FIG2, figure (0,0,0)), 
send (0FIG2, append, 0L) , 
send(0PIC, display, 0FIG2) , 
wt_label ( [NX1,NY1] , [NX2 , NY2 ] , NWTLBL, W) , 

asserta (pix_edge (0FIG2 , NWTLBL, [NX1,NY1] , [NX2,NY2] , W) ) . 

wt_label ( [XI, Yl] , [X2, Y2] , 0 WTLBL, W) 

midpoint ( [XI, Yl] , [X2, Y2] , [XM, YM] ) , 

round (XM, IXM) , 

round (YM, I YM) , 

weights (W) , 

place_lbl (W, WSTR) , 

new (0WTLBL, text (WSTR, IXM, IYM, center) ) , 
send (0 WTLBL, font, font (cour, b, 10) ) , 
send (0pic, display, 0 WTLBL) , 
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place__lbl ( [W, W] , WSTR) number_chars (W, STR) , name (WSTR, STR) , !. 

place_lbl (W, WSTR) concat_atom (W, :,WSTR) , !. 

round__pix (POS, X, Y) : - 
pm_ratio (G) , 
round (G, IG) , 

get (POS , x, XO) , get (POS, y, YO) , 

XI is XO/G, Y1 is YO/G, 
round (XI , X2 ) , round(Yl,Y2) , 

X is X2 *IG, Y is Y2*IG, 

t # 

clicked (PIC, 0POS) 

(retract (point ( LASTPT) ) -> 
round_pix(0LASTPT,Xl, Yl) , 
round_pix(0POS, X2, Y2) , 
new(8L,line(Xl, Y1,X2,Y2) ) f 
send ( @L, arrows, first ) , 

new (@FIG, figure (0, 0, 0) ) , % mouse cannot find simple line 

send (@FIG, append, @L) , % so, must append to a figure. 

send(0PIC, display, 0FIG) , 

wt__label ( [XI, Yl] , [X2, Y2] , WTLBL, W) , 

asserta (pix__edge (0FIG, WTLBL, [XI, Yl] , [X2, Y2] , W) ) , 

assert (point (POS) ) 

/ 

assert (point (POS) ) 



convert_pt ( [PX, PY] , [X, Y] ) : - 

pixels (W) , 
pm_ratio (G) , 

XX is PX/G, 

YY is ( W-PY) / G, 
round (XX, X) , 
round (YY, Y) . 

convert_pix ( [X, Y] , [PX, PY] ) : - 

pixels (W) , 
pm_ratio (G) , 

TPX is G*X, 

TPY is W-G* Y, 
round (TPX, PX) , 
round (TPY, PY) . 

adjustx (XITEM, X) % display transformed x in dialog box 

send (0status, st ring, '') , % clear status line 

pm_ratio (R) , 

XX is X*10/R, 
floor (XX, RX) , 

send (0XITEM, selection, RX) . 



253 



% display transformed y in dialog box 



ad just y (YITEM, Y) 

pm_ratio (R) , 
map^size (M) , 

YY is (10*M)-Y*10/R, 
floor (YY, RY) , 

send ( @ YITEM, selection, RY) . 

mmsave (_, _) 

send (@ status, string, ' SAVING' ) , 
get (@sf ile, string, FILE) , 
send (@sfile, advance, none) , 
open (FILE, write, S) , 
tell (S) , 
pix__to_coord, 

% insert__border , 

told, 

send (@status, string, ' READY' ) . 

concat (SI, S2, S3) 

name (SI , LI ) , 
name (S2, L2) , 
append (Ll , L2 , L3 ) , 
name (S3, L3) . 

pix_to_coord 

nl, 

writeln (':- dynamic mapname/1, edge/6.'), nl, 

get (0sfile, string, MAP) , 

concat ( ' mapname ( ' , MAP , Ml ) , 

concat (Ml, ' ) . ' ,M2) , 

writeln (M2 ) , nl, 

pix_edge (F, W, [PX1,PY1] , [PX2,PY2] , [W1,W2] ) , 
convert_pt ( [PX1,PY1] , [CX1,CY1] ) , 
convert_pt ( [PX2,PY2] , [CX2,CY2] ) , 

EDGE =.. [edge, CXI, CY1, CX2, CY2, W1,W2] , 
portray_clause (EDGE) , 
fail . 

pix_t o_coord. 
insert_border 

nl, writeln ('% border edges'), nl, 
b_edge (XI , Y1 , X2 , Y2 , W1 , W2 ) , 
port ray_clause (edge (XI , Y1 , X2 , Y2 , Wl, W2 ) ) , 
fail . 

insert_border nl. 
draw__border 

b_edge (XI, Yl, X2, Y2 ,_,_) , 
convert_pix( [XI, Yl] , [PX1,PY1]), 
convert_pix( [X2, Y2] , [PX2,PY2] ) , 
new (@L, line (PX1 , PYl, PX2 , PY2 ) ) , 
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send ( G pic, display, 0L) , 
fail. 

draw_border . 

b_edge ( 0, 0,100, 0,1,0). 

b_edge (100, 0,100,100,1,0) . 

b_edge (100, 100, 0,100,1,0) . 

b_edge ( 0,100, 0, 0,1,0). 

mmprint (_, _J : - 

send (0pic, postscript , picfile) , 
unix (system (' lpr -Pssl picfile' )) , 

Unix (system (' rm picfile')), 
unix (system (' Ipq -Pssl' ) ) , 
send (0status, string, ' READY' ) . 

mmclear (_, J : - 

retractall (pix_edge ) t 

send (0pic, clear ) , 
retractall (edge (_, _) ) , 
send (0 status, string, ' ' ) , 
send (0pic, display, 0status) . 

mmload (_, _) 

send (0status, string, ' LOADING' ) , 

get (01f ile, string, FILE) , 

send (0 If ile, advance, none) , 

consult (FILE) , 

draw_edges, 

abolish (edge/6) , 

send (0 status, string, ' READY' ) , 

i 

draw^edges 

edgeO (XI, Yl, X2, Y2, Wl, W2) , 

retractall (weights (_) ) , 

assert a (weights ( [Wl, W2] ) ) , 

convert_pix( [XI, Yl] , [PX1,PY1] ) , 

convert_pix( [X2, Y2] , [PX2,PY2] ) , 

new (0L, line (PX1 , PY1 , PX2 , PY2 ) ) , 

send (0L, arrows, first) , 

new(0FIG, figure (0,0,0)), 

send (0FIG, append, 0L) , 

send (0 pic, display, 0FIG) , 

wt_label ( [PX1 , PY1 ] , [PX2,PY2] , WTLBL, _J , 

assert (pix_edge (0FIG, WTLBL, [PX1,PY1] , [PX2 , PY2 ] , [Wl, W2] ) ) , 
fail. 

draw_edges !. 

mmquit (__, send (0map_dialog, destroy) , halt. 
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